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I.  INTRODUCTION 


A.  OVERVIEW  OF  PATH  PLANNING 

Motion  planning  is  an  important  problem  in  robotics,  computational  geometry,  *nd  many  other  applica¬ 
tions.  A  central  part  of  motion  planning,  known  as  path  or  route  planning,  is  the  process  of  determining  the 
path  to  be  taken  either  by  an  agent’s  appendages  or  by  the  entire  agent  The  research  reported  herein  is  con¬ 
cerned  with  the  latter  of  these  two  path-planning  processes.  Specificall) ,  it  is  concerned  with  planning  paths 
over  long  distances  in  cross-country  terrain.  Thus  we  are  not  concerned  with  small-scale  motion,  where  robot 
appendages  are  moved  among  objects  on  a  work-bench  or  robot  legs  are  placed  on  the  ground,  for  example, 
nor  with  medium-scale  motion,  where  the  agent’s  path  must  be  planned  so  as  to  provide  adequate  clearance 
for  itself,  but  with  large-scale  motion,  where  the  size  of  the  agent  is  negligible  compared  with  the  surround¬ 
ing  terrain. 

Path  planning  will  not  typically  be  the  only,  or  even  the  most  important  task  which  competes  for  comput¬ 
ing  resources.  For  example,  the  purpose  of  an  autonomous  vehicle  is  to  go  somewhere  independently  and  ac¬ 
complish  a  mission,  a  task  which  will  require  a  large  number  of  intermediate  tasks  which  will  each  take 
computing  time  and  space.  Therefore  it  is  important  to  find  path-planning  algorithms  which  use  as  few  resour¬ 
ces  as  possible.  This  means  increasing  run-time  speed  and  at  the  same  time  decreasing  storage  requirements. 
These  are  usually  conflicting  goals,  but  it  is  often  possible  to  increase  run-time  performance  or  reduce  storage 
at  the  expense  of  preprocessing  time  in  a  pre-inission  phase  when  resources  are  not  in  demand. 

The  problem  of  finding  an  optimal  (least-cost)  path  between  two  points  for  i.  negligibly  small  agent  over 
fixed,  two-dimensional  terrain  with  known  cost  characteristics  can  be  attacked  by  several  methods.  When  the 
agent  is  constrained  to  travelling  on  a  finite  number  of  known  paths,  the  problem  can  be  solved  by  network 
search  algorithms,  a  subject  of  thorough  study  in  operations  research.  When  the  agent  is  not  constrained  to 
travelling  on  specified  paths,  the  area  is  called  free  space.  Path  planning  in  two-dimensional  free  space  is 
beginning  to  be  studied  in  depth  by  researchers  in  such  fields  as  artificial  intelligence,  robotics,  and  computa¬ 
tional  geometry.  Most  methods  require  homogeneous-cost  background  terrain  interspersed  with  impassable 
obstacles,  as  for  example  for  the  Visibility-Graph  algorithms  [Ref.  IJ.  However,  handling  additional  types  of 
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terrain  features  (for  example,  linear  low-cost  features,  e.g.,  roads,  linear  fixed-crossing-cost  features,  e.g., 
rivers,  [Ref.  2]  and  polygonal  regions  of  homogeneous-cost  terrain,  e.g.,  forests,  swamps,  or  fields,  [Ref.  3]) 
will  improve  the  ability  to  model  terrain  realistically. 

A  promising  approach  to  two-dimensional  path-planning  in  free  space  which  we  develop  in  this  research, 
called  the  optimal-path-map  approach,  provides  greatly  improved  run-time  speed  at  the  expense  of  preprocess¬ 
ing  time  and  storage.  This  approach  partitior  the  plane  during  preprocessing  into  regions  with  similarly-be¬ 
haved  optimal  paths  and  then  locates  a  start  point  in  this  partition  at  run  time.  Figure  1  shows  an  example 
optimal-path  map  with  boundaries  separating  the  regions  of  similarly-behaved  optimal  paths.  Additionally,  a 
set  of  vectors  is  superimposed  on  the  optimal-path  map  in  Figure  1  showing  initial  directions  of  selected  op¬ 
timal  paths.  We  develop  the  theoretical  basis  for  such  a  partitioning  for  a  more  general  set  of  terrain  features 
man  has  previously  been  used  in  optimal-path-map  construction,  making  this  approach  more  practical  for  real- 
woild  cross-country  path  planning.  Tlien  once  the  optimal-path  map  is  constructed,  our  approach  can  appeal 
to  algorithms  with  worst-case  lime  complexity  of  0(iog  n)  to  locate  a  start  point  in  a  planar  partition  (see  Chap¬ 
ter  11,  Section  B),  where is  the  number  of  terrain-feature  vertices.  Once  the  start  point  is  located  in  the  par¬ 
tition,  the  beliavior  of  the  optimal  path  is  identified  and  the  path  can  be  reconstructed.  This  response  time  is 
very  attractive,  especially  for  real-time  systems  like  missiles  or  for  systems  with  many  competing  computing 
requirements  like  autonomous  vehicles. 

Tire  principal  results  of  our  research  are  threefold.  First,  we  adapted  the  wavefront  propagation  algorithm 
to  find  boundaries  between  regions  of  start  points  whose  optimal  paths  are  similarly  behaved,  and  implemented 
three  versions  of  the  new  algorithm.  Second,  we  characterized  boundaries  mathematically  by  means  of  analytic 
geometry.  Third,  we  proposed  an  algorithm  to  construct  the  planar  partition  using  these  mathematical  results 
for  convex  polygonal  and  piecewise-lirrear  terrain,  as  an  alternative  to  our  wavefront  propagation  algoritiim. 

B.  ASSUMPTIONS 

We  assume  that  the  terrain  is  known,  and  can  be  modelled  by  combinations  of  the  five  primitive  types  of 
terrain  features  presented  below.  We  assume  that  terrain-feature  edges  can  be  modelled  piecewise-linearly, 
that  terrain  is  isotropic  (traversal  cost  is  independent  of  direction  of  travel),  and  that  no  two  polygonal  regions 
have  common  vertices.  Although  the  mobile  agent  is  constrained  to  travel  in  the  two-dimensional  plane  of  the 
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input  map,  assigned  costs  of  travel  may  reflect  that  the  actual  surface  being  traversed  varies  in  height.  (See 
also  Chapter  11,  Sections  C  and  D.) 

Following  Mitchell  [Ref.  4],  we  make  the  assumption  called  the  general-position  assumption  (Appendix 
A,  Assumption  1-3),  that  no  terrain-feature  vertex  lies  on  a  homogeneous-behavior  boundary  generated  by 
another  terrain  feature,  i.e.,  that  there  is  not  an  accidental  alignment  of  boundaries  with  terrain-feature  ver¬ 
tices.  This  restriction  does  not  change  the  following  results  significantly,  but  allows  the  discussion  !o  proceed 
without  convoluted,  but  unimportant,  conventions.  In  an  actual  implementation  of  the  algorithms  proposed 
below,  this  assumption  must  be  retracted. 

The  following  five  terrain-feature  types  are  allowed: 

•  Background.  Areas  of  the  map  which  do  not  contain  other  terrain  features  have  a  fixed  cost 
per  distance  travelled. 

«  Obstacles.  An  obstacle  is  a  convex  polygon  enclosing  impassable  terrain. 

•  Rivers.  A  river  segment  is  a  line  segment  whose  cost  to  the  agent  to  cross  anywhere  along  its 
length  is  a  fixed  constant,  not  dependent  on  the  angle  of  crossing. 

•  Roads.  A  road  segment  is  a  line  segment  with  a  fixed  cost  per  distance  for  length-wise  traver¬ 
sal.  Thus  a  road  segment  is  infinitesimally  thin,  can  be  crossed  at  no  cost  to  tbe  agent,  and  can 
be  entered  or  left  anywhere  along  its  length. 

•  Convex  Homogeneous-Cost  Areas.  A  convex  liomogeneous-cost  area  ( HCA )  is  a  convex 
polygon  with  a  constant  positive  cost  per  distance  travelled.  An  HCA  may  have  cost  per  dis¬ 
tance  greater  or  less  than  the  background  terrain,  but  not  zero.  The  agent  may  enter  or  leave  tbe 
area  at  any  point  on  its  circumference  at  no  additional  cost. 

These  terrain-feature  types  could  all  be  modelled  by  HCAs.  However,  allowing  obstacle,  river,  and  road 
terrain  features  enhances  efficiency  by  allowing  us  to  take  advantage  of  their  simplicity.  Specifically,  it  is  an 
advantage  to  avoid,  where  possible,  the  complicated  analysis  of  paths  through  homogeneous-cost  regions  (see 
Chapter  li,  Section  E2b(3)). 

How  realistic  are  tbe  above  assumptions?  There  arc  at  least  three  issues.  First,  is  it  reasonable  to  expect 
tbit  we  know  the  characteristics  of  the  terrain;  second,  car  terrain  be  adequately  modelled  by  piecewise  linear 
curves;  and  third,  will  the  use  of  convex  uon-adjacent  polygons  be  sufficient?  As  discussed  in  Chapter  II,  Sec¬ 
tion  D4,  tbe  Defense  Mapping  Agency  and  oh.  U.S.  Government  agencies  currently  have  the  ability  to 
produce  maps  which  characterize  terrain  according  to  the  speed  at  which  a  given  vehicle  type  can  traverse  it. 
(Of  course,  cost  in  terms  of  time  is  the  reciprocal  of  speed.)  The  program  used  to  produce  these  maps,  called 
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ArmyMobility  Model  (AMM),  takes  as  input  a  digitized  combination  of  soil  conditions,  vegetation,  man-made 
features,  and  elevation  which  is  available  at  present  only  for  selected  areas  of  the  earth,  but  there  is  an  ongo¬ 
ing  effort  to  expand  this  database.  As  this  database  is  expanded,  AMM  will  be  able  to  produce  cost  maps  of 
more  of  die  world's  surface,  so  that  a  path-planning  system  which  uses  AMM  cost  maps  as  input  can  be  ex¬ 
pected  to  know  the  characteristics  of  the  terrain.  Hov/ever,  an  additional  consideration  is  that  terrain  may  be 
impermanent.  In  this  case  our  assumptions  will  be  invalidated. 

The  second  issue  is  whether  terrain  can  be  adequately  modelled  using  only  piecewise  linear  curves.  Com¬ 
putational  geometry  relies  very  heavily  on  the  use  of  piecewise  linear  curves  to  approximate  reality,  since  there 
is  a  fixed  precision  associated  with  any  computer,  and  a  finite  amount  of  storage.  In  fact,  the  very  concept  of 
continuity  is  a  mathematical  abstraction,  since  at  some  level  the  most  smoothly  continuous  curves  will  be  seen 
to  degenerate  into  discrete  elements.  For  example,  a  wood-line  may  seem  to  form  a  continuous  curve,  wheu 
in  fact  at  the  scale  of  individual  trees  it  is  clearly  discontinuous.  Since  tlie  database  maintained  by  the  Defense 
Mapping  Agency  has  a  maximum  resolution  of  12.5  meters  square,  we  can  be  assured  that  no  representation 
we  propose  will  be  more  accurate  than  this.  One  additional  consideration  is  that  small  nuances  of  the  terrain 
will  normally  have  much  less  effect  on  optimal  paths  than  will  large  features.  Of  course,  it  is  always  desirable 
from  the  viewpoint  of  efficiency  to  use  as  few  line  segments  as  possible  to  approximate  a  curve  in  order  to 
reduce  the  number  of  terrain-feature  vertices  in  the  input  map. 

The  third  question  is  much  more  of  a  problem.  The  use  of  convex  polygons  will  clearly  net  approximate 
all  types  of  terrain  if  we  require  that  no  two  polygons  have  common  vertices.  The  output  of  Army  Mobility 
Model  for  example,  allows  non-convex  polygons.  Tliis  research  uses  the  non-adjacent-convex-polygon  as¬ 
sumption  in  order  to  attack  a  problem  of  somewiial  smaller  scope  first,  with  the  intention  of  expanding  (be 
scope  in  the  future  to  incorporate  non-convex  regions.  Tire  next  step  will  be  to  extend  the  analysis  of  Chapter 
V  to  include  tire  case  of  adjacent  convex  polygons. 

C.  THE  OPTIMAL-PATH-MAP  APPROACH  TO  PATH-PLANNING 

The  optimal-palli-map  approach  to  path  planning  groups  paths  according  to  their  general  behavior  with 
respect  to  a  goal  point.  A  surjective  function  is  defined  to  map  optimal  paths  to  generalizing  path  descriptions 
so  that  paths  with  similar  behavior  are  mapped  to  the  same  description.  The  usual  definition  of  "similar  be- 


havior"  is  crossing  tbe  same  sequence  of  terrain-feature  vertices  and  edges.  Boundaries  are  constructed  to  par¬ 
tition  the  plane  of  the  map  into  regions  whose  start  points  have  similar  behavior.  Then  to  determine  an  optimal 
path,  a  given  start  point  is  located  rilhin  tbe  partition.  Tbe  path  description  of  tbe  region  associated  with  tbe 
start  point  applies  to  tbe  optimal  path  from  tbe  start  point,  so  this  path  description  is  specialized  for  tbe  given 
start  point  to  give  an  optimal  path.  Ibe  focus  of  our  research  is  tbe  construction  of  tbe  planar  partition. 

How  can  paths  be  represented  so  they  can  be  grouped  according  to  tbeir  behavior?  Theorem  1-2  states  that 
optimal  paths  among  piecewise-linear  and  polygonal  terrain  are  always  piecewise  linear,  changing  direction 
only  at  terrain-feature  vertices  and  edges.  This  fact  suggests  two  possible  ways  to  represent  optimal  paths.  The 
more  natural  way  to  represent  a  single  piecewise-linear  path  would  be  by  listing  the  coordinates  of  its  turn 
points.  Alternately,  we  could  list  the  ‘crrain-feature  vertices  and  edges  at  which  a  path  turns.  Tbe  first  repre¬ 
sentation  has  tbe  difficulty  that  there  is  no  immediate  way  to  tell  from  the  list  whether  or  cot  turn  points  from 
two  different  paths  lie  on  tbe  same  terrain-feature  edge.  Tbe  second  representation  allows  paths  to  be  grouped 
more  easily  seconding  to  whether  they  cross  tbe  same  terrain-feature  edges  and  vertices,  but  has  tbe  difficul¬ 
ty  that  it  is  not  clear  by  looking  at  tbe  list  what  tbe  coordinates  of  a  turn  point  are  on  a  terrain-feature  edge, 
fhis  conflict  suggests  a  composite  representation  wherein  a  list  contains  terrain-feature  vertices  and  edges, 
and  for  each  edge,  may  also  contains  as  supplemental  information  tbe  exact  coordinates  at  which  tbe  path  cros¬ 
ses  tbe  edge.  This  is  tbe  representation  we  adopt,  calling  such  a  list  a  path  list. 

Tbe  path  list  can  be  used  to  represent  a  specific  optimal  path  as  well  as  a  generalized  description  of  an 
optimal  path.  If  a  path  list  has  a  terrain-feature  vertex  as  its  first  element,  die  path  is  completely  determined 
because  it  will  go  from  the  start  point  directly  to  the  vertex,  from  where  a  unique  path  goes  to  the  goal  (Corol¬ 
lary  1-3.1,  Appendix  A).  If  a  path  list  has  an  edge  as  its  first  element  and  no  supplemental  information  is  in¬ 
cluded  with  that  edge,  the  path  list  represents  all  optimal  paths  whose  first  turn  point  lies  on  that  edge.  If 
however,  coordinates  of  tbe  crossing  point  are  included  with  tbe  edge,  thepath  is  completely  determined.  When 
listing  an  edge  in  a  path  list,  it  is  also  important  to  distinguish  between  edges  crossed  from  different  directions, 
because  for  example,  paths  may  enter  the  same  portion  of  a  road  from  both  sides;  we  want  to  distinguish  be¬ 
tween  tbe  two  sets  of  paths  which  come  from  either  side  of  tbe  road.  For  consistency  in  our  discussions,  we 
adopt  tire  convention  that  for  a  start  point  with  no  feasible  paths  (for  example,  a  start  point  inside  an  impass¬ 
able  obstacle),  the  optimal-path  list  is  a  null  symbol  concatenated  with  the  goal  point. 
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Now  the  path-generalizing  function  can  be  defined  more  fully  for  the  usual  definition  of  similar  bebavior 
of  paths.  For  the  set  0  of  all  optimal  paths  and  the  set  (VUE)*  of  all  combinations  of  terrain-feature  vertices 
and  edges,  the  function  f :  0  — »(VUE)*  maps  an  optimal  path  to  its  path  list. 

Define  a  homogeneous-behavior  region  with  respect  to  a  goal  G  as  the  set  of  all  start  points  whose  op¬ 
timal  paths  are  mapped  by  the  path-generalizing  function  to  the  same  set.  Thus,  start  points  whose  optimal 
paths  have  the  same  path  lists  are  considered  to  be  in  the  same  homogeneous-behavior  region  for  the  usual 
definition  of  the  path-generalizing  function.  Define  the  root  of  a  homogeneous-behavior  region  as  the  first  ele¬ 
ment  of  the  path  list  associated  with  the  region.  Since  a  root  may  represent  a  terrain-feature  edge  which  can 
be  crossed  at  any  point  along  its  length,  the  supplemental  information  cannot  be  retained  by  the  path  list  as¬ 
sociated  with  the  root  Define  a  homogeneous-behavior  boundary  as  the  locus  of  points  lying  in  two 
homogeneous-behavior  regions.  On  a  homogeneous-behavior  boundary  (except  for  obstacle  edges),  at  least 
two  optimal  paths  exist  for  a  given  point. 

The  fundamental  principle  upon  which  spatial  reasoning  about  optimal  paths  is  based  is  the  principle  of 
optimality.  In  its  general  sense,  the  principle  of  optimality  states  that  if  it  applies  to  a  system,  future  optimal 
policy  in  the  system  depends  only  on  its  current  state  and  not  on  its  past  history.  Theorem  1-1  (Appendix  A) 
states  that  the  principle  of  optimality  applies  to  the  path-planning  domain.  In  other  words,  it  states  that  the 
portion  of  an  optimal  path  from  any  point  on  the  path  to  the  goal  is  also  an  optimal  path. 

We  extend  the  general-position  assumption  discussed  above  to  terrain  feature  edges  by  adopting  the  con¬ 
vention  that  any  terrain  feature  edge  intersected  by  a  homogeneous-behavior  boundary  is  to  be  treated  as  two 
distinct  edges,  one  on  each  side  of  the  boundary.  The  immediate  result  or  this  assumption,  the  principle  of  op¬ 
timality,  and  Theorem  1-2,  is  the  uniqueness  of  optimal  paths  from  any  terrain  feature  vertex  or  across  the  in¬ 
terior  of  any  edge.  (Corollary  1-3.1,  Appendix  A.)  It  follows  from  the  definitions  of  homogeneous-behavior 
regions,  roots,  and  boundaries,  the  general-position  assumption,  and  Theorem  1-2  that  there  is  a  unique  root 
associated  with  each  homogeneous-behavior  region  (Corollary  1-3.2).  It  also  follows  that  homogeneous-be¬ 
havior  regions  are  "star-shaped"  with  respect  to  the  region  root  (Corollary  1-3.3). 

An  optimal-path  tree  of  a  set  of  terrain  features  with  respect  to  a  goal  point  is  the  index  tree  for  all  pos¬ 
sible  path  lists.  In  other  words,  it  is  the  tree  whose  root  represents  the  goal  and  whose  internal  nodes  are  ter¬ 
rain-feature  vertices  and  edges,  such  that  for  each  node,  the  optimal  paths  from  that  node’s  vertex  or  edge  go 
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first  to  the  vertex  or  edge  represented  by  the  node's  parent.  Therefore,  the  path  list  for  the  vertex  or  edge  as¬ 
sociated  with  a  node  is  found  by  following  the  parent  pointer  of  the  node  back  to  the  root  of  the  tree,  which  is 
the  goal.  Each  node  of  the  tree  corresponds  to  aunique  homogeneous-behavior-region  root,  which  corresponds 
to  a  unique  homogeneous-behavior  region.  Thus,  locating  a  start  point  in  a  region  of  the  planar  partition  is 
equivalent  to  specifying  which  node  of  the  tree  identifies  the  behavior  of  the  optimal  path  from  that  start  point. 
Figure  2  shows  an  example  planar  partition  with  its  corresponding  optimal-path  tree. 

An  initial  version  of  the  optimal-path  tree  can  be  constructed  by  using  a  point-to-point  path  planner  to 
compute  the  optimal  path  from  each  terrain-feature  vertex  on  the  input  map  and  then  inserting  the  turn  points 
of  each  resulting  optimal  path  into  a  tree.  The  method  presented  in  Chapters  V  and  VI  uses  the  optimal-path 
tree  to  construct  the  planar  partition,  and  revises  it  by  insetting  nodes  which  correspond  to  terrain-feature  edges. 
However,  the  method  presented  in  Chapter  HI  constructs  the  optimal-path  tree  at  the  same  time  as  it  constructs 
the  planar  partition. 

An  optimal  path  map  or  OPM  is  a  partition  of  the  plane  into  homogeneous-behavior  regions  with  respect 
to  a  goal,  along  with  its  associated  optimal-path  tree.  There  is  a  finite  optimal-path  tree  associated  with  every 
two-dimensional  map  consisting  of  terrain  as  defined  above  (Theorem  1-4,  Appendix  A).  The  specification  of 
this  optimal-path  tree  is  a  necessary  part  of  the  optimal-path  map,  and  we  will  assume  that  the  term  optimal- 
path  map  implies  both  the  representation  of  the  planar  partition  and  pf  the  optimal-path  tree,  with  some  means 
of  linking  each  node  with  its  corresponding  homogeneous-behavior  region  in  the  partition.  A  typical  repre¬ 
sentation  of  the  planar  partition  is  the  doubly-connected-edge-list  discussed  in  Chapter  II,  Section  E. 

Several  partitioning  algorithms  for  terrain  containing  only  obstacles  (the  binary  case)  have  been  proposed 
in  an  attempt  to  present  fastersolutions  to  the  point-to-point  path-planning  problem  (see  Chapter  2),  and  several 
algorillims  even  solve  a  portion  of  the  optimal-path-map  problem  with  respect  to  weighted  regions  by  creat¬ 
ing  the  optimal-path  tree  in  pursuit  of  single-path  solutions.  In  this  research,  we  investigate  the  problem  of 
creating  an  optimal-path  map  for  weighted-region  terrain,  focusing  on  a  solution  to  the  optimal-path-map 
problem  as  an  end  in  itself.  We  choose  to  investigate  this  approach  because  it  offers  the  most  opportunity  for 
enhancement  of  run-time  performance  at  the  expense  of  preprocessing  time  because  of  the  promise  of  0(log 
n)  run-time  complexity  to  identify  an  optimal  path  for  a  map  of  n  terrain-feature  vertices. 
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Figure  2 

Planar  Partition  with  Corresponding  Optimal-Path  Tree 
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D.  SUMMARY  OF  RESEARCH  REPORTED  HEREIN 


In  Chapter  II,  we  explain  and  classify  the  path-planning  algorithms  relevant  to  this  research,  specifically 
those  dealing  with  negligible-sized  agents  in  a  fixed,  known  environment  where  terrain  is  two-dimensional, 
free  space. 

One  method  of  obtaining  sub-optimal  solutions  to  the  optimal-path-map  problem  uses  a  version  of  the 
standard  wavefront  propagation  algorithm.  Such  an  algorithm  is  presented  in  Chapter  III,  and  the  extensions 
necessary  to  create  optimal-path  maps  are  developed.  Chapter  IV  is  an  analysis  of  the  algorithm  in  tie  pre¬ 
vious  chapter.  Two  primary  sources  of  error  are  examined,  and  known  results  of  inherent  inaccuracy  in 
wavefront  propagation  are  extended  to  the  resulting  OPMs.  The  theoretical  time  and  space  complexity  of  the 
above  algorithm  is  presented,  along  with  empirical  results  concerning  execution  times  for  three  alternative 
heuristics  used  with  the  algorithm. 

A  second  approach  to  solving  the  two-dimensional  optimal-path-map  problem  is  to  reason  about  how  op¬ 
timal  paths  behave  in  the  presence  of  various  terrain  features.  This  reasoning  leads  to  analytical  characteriza¬ 
tion  of  the  boundaries  between  homogeneous-behavior  regions  of  similarly-behaved  optimal  paths  as  functions 
of  terrain  feature  characteristics.  It  turns  out  that  all  boundaries  generated  by  the  roads,  rivers,  and  obstacles 
are  segments  of  conic  sections.  Other  boundaries  are  more  mathematically  complex,  and  in  many  cases  can¬ 
not  be  described  in  closed-form  expressions.  First  in  Chapter  V,  a  set  of  definitions  is  presented,  followed  by 
development  of  the  characterizations  of  boundaries  generated  by  "primitive"  terrain  feature  types,  i.e.,  single 
polygons  and  single  line-segments.  Then  the  characterization  of  more  complex  combinations  of  primitive  ter¬ 
rain  features  is  discussed,  and  decomposability  is  defined  for  construction  of  optimal-path  maps. 

in  Chapter  VI,  algorithms  use  the  results  of  Chapter  V  to  generate  OPMs  more  accurate  than  those  of 
Chapter  III  for  isolated  occurrences  of  each  type  of  primitive  terrain  feature.  Then  an  algorithm  based  on  the 
dividc-and-conquer  paradigm  is  presented  to  generate  OPMs  for  some  "decomposable"  maps  with  multiple 
terrain  features.  In  Chapter  VII  the  divide-ami -conquer  exact-OPM  algorithm  is  analyzed,  first  in  terms  of 
sources  of  error,  and  then  with  respect  to  theoretical  time  and  space  complexity.  Then  tire  empirical  perfor¬ 
mance  of  an  implementation  is  discussed.  Chapter  VIII  summarizes  the  results  of  the  research. 
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H.  RELEVANT  RESEARCH 


A.  APPLICABLE  CONCEPTS  FROM  ARTIFICIAL  INTELLIGENCE 
1.  Search  Methods 

One  of  the  central  problem-solving  techniques  in  Artificial  Intelligence  is  the  use  of  search  [Ref.  5], 
[Ref.  6].  A  search  problem  is  couched  in  terms  of  a  current  state  and  a  goal  state,  operators  are  defined  which 
transform  the  system  from  one  state  to  another,  and  a  search  is  conducted  for  a  sequence  of  operators  which 
will  transform  the  current  state  to  a  goal  slate.  Conceptually,  a  search  space  is  a  directed  graph  whose  nodes 
represent  all  possible  states,  and  whose  edges  represent  operators.  Solving  the  problem  means  applying  graph- 
search  algorithms  in  the  search  space  to  find  a  path  from  a  start  node  to  a  goal  node.  The  search  space  may  be 
a  very  large,  even  an  infinite  graph  which  is  not  represented  explicitly,  but  as  the  algorithm  proceeds,  it  creates 
a  sub-graph,  called  a  search  graph  (or  search  tree),  whose  nodes  are  the  states  actually  reached  during  the 
search.  The  underlying  aim  is  to  find  ways  to  make  the  search  graph  as  small  as  possible  while  still  L  eluding 
the  goal  state,  i.e.,  to  look  at  as  few  states  of  the  search  space  as  possible  on  the  way  to  finding  the  goal.  There 
are  two  ways  of  limiting  the  size  of  the  search  graph.  One  way  is  to  guide  the  search  by  means  of  heuristics, 
and  the  other  is  to  represent  the  problem  in  such  a  way  as  to  reduce  the  search  space. 

When  no  domain-specific  information  is  used  to  guide  decisions  about  which  node  of  the  search  graph 
to  process  next,  the  process  is  called  blind  search.  Although  few  problems  have  a  search  space  small  enough 
to  allow  practical  use  of  blind  search,  the  techniques  used  provide  the  foundation  for  heuristic  search,  where 
information  is  used  to  guide  the  search.  All  the  search  techniques  discussed  below  can  be  said  to  conform  to 
a  general  model  where  the  search  is  initialized  by  placing  an  initial  node  on  an  agenda,  and  proceeds  by  ex¬ 
panding  die  first  node  on  the  agenda,  putting  the  node’s  children  on  the  agenda  in  a  manner  which  varies  from 
technique  to  technique. 

Branch-and-bound  search,  also  known  as  Dijkstra's  algorithm,  is  a  generalization  of  breadth-first 
search  which  uses  heuristic  information.  The  distance  of  a  node  from  the  start  is  not  measured  by  the  number 
of  edges  from  the  node  to  the  root  as  in  breadth-first  search,  but  by  the  total  cost  of  the  edges.  Thus,  each  edge 
has  an  associated  cost,  and  at  each  iteration,  after  a  node  has  been  expanded  and  its  children  placed  in  the  agen- 
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da,  the  agenda  is  sorted  by  cost  to  keep  lower-cost  nodes  first.  Since  physical  distance  is  the  normal  metric  in 
the  path-planning  domain,  this  is  a  natural  search  technique  to  use.  This  technique  guarantees  that  the  first  path 
found  to  the  goal  is  the  lowest-cost  solution. 

Another  search  strategy  which  is  widely  used  in  path  planning  is  called  A*  search.  It  sorts  its  agen¬ 
da  according  to  the  sum  of  the  cost  function  and  evaluation  function  at  each  node.  If  the  evaluation  function 
value  from  any  point  to  the  goal  is  a  lower  bound  on  the  actual  cost  from  the  point  to  the  goal,  it  is  guaranteed 
that  the  first  time  the  optimal  path  to  the  goal  is  selected  from  the  agenda  it  will  be  recognized  as  optimal. 

2.  Domain-Specific  Heuristics  as  Guides  to  Search 

General  solutions  to  problems  tackled  by  Artificial  Irtelligence  researchers  are  usually  so  difficult 
that  great  advantages  are  to  be  gained  by  finding  rules-of-thumb  to  focus  the  search  in  the  right  direction. 
Heuristic  search  strategies  use  cost  and/or  evaluation  functions  to  guide  the  search.  Rich  [Ref.  7]  states  that 
the  field  of  artificial  intelligence  is  largely  the  study  of  heuristic  search  for  solving  difficult  problems,  and  The 
Handbook  of  Artificial  Intelligence  calls  heuristic  search  "one  of  the  key  contributions  of  Artificial  Intelligence 
to  efficient  problem-solving"  [Ref.  5].  In  the  path-planning  domain,  there  is  a  natural  heuristic  which  is  often 
used  to  guide  search  for  an  optimal-cost  path,  which  is  that  for  a  path  from  the  start  point  to  an  intermediate 
point,  if  the  intermediate  point  is  closer  in  straight-line  distance  to  the  goal  than  some  other  intermediate  point 
from  another  path  (irrespective  of  terrain  yet  to  be  negotiated), the  first  path  is  preferred  over  the  second  for 
further  exploration. 

3.  Problem  Representation 

It  is  often  the  case  in  problems  studied  in  artificial  intelligence  research  that  a  problem  which  seems 
very  difficult  when  represented  in  one  way  will  suggest  a  natural  solution  when  represented  in  a  different  way. 
In  other  words,  finding  a  good  problem  representation  is  often  tbe  key  to  efficient  solution  of  the  problem,  as 
well  as  to  clear  understanding  of  the  problem  on  the  part  of  researchers  [Ref.  5).  Path-planning  algorithms,  for 
example,  are  essentially  ways  of  transforming  an  infinite  search  space  to  a  finite  one,  and  then  searching  the 
transformed  search  space  using  one  of  several  heuristic-aided  search  algorithms  discussed  above. 
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B.  APPLICABLE  CONCEPTS  FROM  COMPUTATIONAL  GEOMETRY 


1.  Definitions  for  Optimal-Path  Maps 

a.  Path  List 

When  optimal  paths  are  guaranteed  to  consist  of  line  segments  between  a  finite  number  of  turn 
points,  which  Theorem  1-2  shows  is  true  of  the  terrain  considered  in  this  research,  they  can  be  represented  by 
listing  these  turn  points.  It  is  also  shown  in  Theorem  1-2  that  these  turn  points  occur  only  at  terrain-feature  ver¬ 
tices  and  edges.  This  suggests  two  possible  ways  to  list  the  turn  points.  The  most  direct  way  is  to  list  the  coor¬ 
dinates  of  the  points.  This  allows  direct  reconstruction  of  the  path  from  its  list.  However,  this  representation 
makes  it  somewhat  more  difficult  to  compare  two  lists  to  determine  if  the  paths  they  represent  cross  the  same 
edges.  It  might  be  better  to  list  explicitly  the  vertices  and  edges  that  a  path  crosses.  This  representation  has  the 
drawback,  however,  that  some  computation  would  be  necessary  to  determine  for  each  edge  crossing  exactly 
where  the  crossing  occurred.  Since  our  research  is  primarily  concerned  with  grouping  paths  together  accord¬ 
ing  to  their  general  behavior,  we  adopt  the  second  representation,  calling  such  a  list  a  path  list.  An  example 
path  list  from  start  point  S  to  goal  point  G  in  Figure  3  is  [E,A,G],  while  from  point  R  there  are  three  possible 
good  path  lists  of  [F,C,G],  [H,G],  and  IPQ.G].  For  consistency  in  later  discussions,  we  say  that  for  a  start  point 
with  no  feasible  paths  (for  example  a  start  point  in  the  center  of  an  impassable  obstacle),  the  path  list  consists 
of  a  special  null  symbol  concatenated  with  the  goal  point. 

b.  Path-Generalizing  Function 

The  concept  upon  which  the  oplimal-path-map  approach  to  path  planning  is  based  is  that  paths 
can  be  grouped  according  to  their  behavior.  A  path-generalizing  function  f:0—>B  is  defined  from  the  set  of 
optimal  paths  to  the  set  of  behaviors  of  optimal  paths,  which  maps  an  optimal  path  to  a  description  of  its  be¬ 
havior.  Since  many  paths  may  share  the  same  behavior  descriptions,  f  is  a  surjective  function.  The  usual  way 
to  define  the  behavior  of  a  path  is  by  listing  the  vertices  and  edges  it  crosses.  In  that  case  B  =  (VUE)*,  the 
set  of  all  combinations  of  terrain-feature  vertices  and  edges.  Since  path  lists  are  defined  in  terms  of  vertices 
and  edges,  the  usual  definition  of  f  is  that  it  maps  an  optimal  path  to  its  path  list. 

A  path-generalizing  relation  R  which  relates  two  points  if  the  path-generalizing  function  maps 
tlieir  optimal  paths  to  identical  path  lists  is  an  equivalence  relation  because  the  identity  relation  is  in  general 
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an  equivalence  relation.  Since  the  domain  of  f  is  the  set  of  all  points  on  tbe  input  map,  f  induces  a  partition  on 
the  plane  of  the  input  map  through  this  equivalence  relation. 

c.  Homogeneous-Behavior  Region 

Define  a  homogeneous-behavior  region  with  respect  to  a  goal  point  and  a  path- generalizing  func¬ 
tion  as  tbe  set  of  start  points  whose  optimal  paths  to  that  goal  point  are  mapped  by  the  path-generalizing  func¬ 
tion  to  the  same  path  behavior.  In  our  work,  this  is  equivalent  to  saying  that  it  is  the  set  of  start  points  whose 
optimal  paths  have  tbe  same  path  lists.  Each  homogeneous-behavior  region  corresponds  to  an  equivalence 
class  of  tbe  path-generalizing  relation  R,  and  so  is  a  subdivision  of  tbe  partition  induced  by  R  on  the  plane  of 
the  input  map.  In  Figure  3,  for  example,  point  S  is  in  the  homogeneous-behavior  region  enclosed  by  segments 
El,  IK,  KL,  and  LE. 

An  optimal-path  map  (OPM)  is  defined  as  the  partition  of  the  plane  of  the  input  map  into 
homogeneous-behavior  regions,  along  with  their  associated  path  lists.  For  tbe  conceptual  representation  of  an 
optimal-path  map  shown  in  tbe  top  half  of  Figure  3,  the  two  data  structures  in  the  bottom  half  of  the  figure 
fully  specify  the  OPM. 

d.  Homogeneous-Behavior-Region  Root 

Because  of  the  definition  of  homogeneous-behavior  regions,  each  unique  path  list  defines  a 
homogeneous-behavior  region.  Thus  given  a  path  list,  the  associated  region  is  defined.  By  the  general-posi¬ 
tion  assumption  (Assumption  1-3,  Appendix  A),  there  will  be  no  accidental  alignment  of  boundaries  from 
another  region  such  that  there  is  more  than  one  path  list  from  a  region.  Tbe  first  element  of  the  path  list  as¬ 
sociated  with  a  region  is  defined  as  the  homogeneous-behavior-region  root.  For  example,  in  Figure  3  the  path 
list  of  start  point  S  with  respect  to  goal  point  G  is  [E,A,G],  and  point  E  is  tbe  region  root  of  the  region  of  which 
S  is  a  member. 

2.  Data  Structures 

Several  data  structures  with  wide  utility  in  computational  geometry  ate  useful  in  the  optimal-path- 
map  domain.  Since  an  optimal-path  map  consists  of  tbe  set  of  path  lists  from  homogeneous-behavior-rcgion 
roots  and  a  planar  partition,  these  two  items  must  be  represented. 
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a.  The  Optimal-Path  Tree 

The  optimal-path  tree  is  a  way  of  representing  a  set  of  path  lists.  It  is  a  direct  extension  of  the 
shortest-path  tree  concept  [Ref.  8J.  An  optimal-path  tree  (OPT)  is  a  tree  whose  root  (not  the  same  as  a 
homogeneous-behavior-region  root)  is  the  specified  goal  point,  whose  nodes  are  terrain-feature  vertices  and 
edges,  and  for  which  an  optimal  path  from  the  terrain-feature  vertex  or  edge  represented  by  any  node  in  the 
tree  goes  directly  to  the  vertex  or  edge  represented  by  that  node's  parent.  Each  node  of  the  tree  corresponds 
to  a  homogeneous-behavior  region,  and  every  homogeneous-behavior  region  is  represented  by  a  node,  (see 
Theorem  1-4,  Appendix  A).  Thus  by  labeling  regions  and  OPT  nodes  the  same,  or  by  establishing  pointers 
from  regions  to  nodes  of  the  OPT,  a  linkage  is  established  which  allows  retrieval  of  the  appropriate  OPT  node 
given  a  region.  Then  the  path  list  associated  with  the  region  can  be  reconstructed  by  tracing  upwards  through 
the  tree  to  the  tree’s  root.  Note,  however,  that  funner  computation  usually  is  necessary  to  reconstruct  the  op¬ 
timal  path  from  the  path  list  by  finding  optimal  edge  crossings.  Another  important  characteristic  of  the  op¬ 
timal-path  tree  is  that  it  reduces  the  redundancy  of  storage  of  optimal  paths  associated  with  terrain-feature 
vertices  and  edges  by  integrating  them  all  into  one  structure.  In  figure  3,  the  optimal-path  tree  is  shown  for 
tlie  given  terrain  map. 

b.  The  Doubly-Connected  Edge  List  (DCEL) 

A  planar  partition  could  be  represented  in  edge-list  form  in  which,  for  each  vertex  of  a  piecewise- 
1  inear  approximation  of  the  boundary  between  subdivisions  of  the  partition  an  ordered  list  of  its  incident  edges 
is  given.  Although  this  is  a  natural  representation,  some  of  the  information  implicitly  present  could  be  explicit¬ 
ly  listed,  enhancing  efficiency  at  the  expense  of  preprocessing  time  and  storage.  A  doubly-connected  edge  list 
is  such  a  data  structure  that  has  proven  to  be  quite  useful  in  representing  a  planar  partition.  Represent  each 
edge  as  a  node  in  the  DCEL,  and  label  each  edge,  vertex,  and  region.  Note  that  the  terms  edge  and  vertex  as 
used  in  connection  with  the  DCEL  refer  to  piecewise-linear  homogeneous-behavior-region  boundary  edges 
and  vertices,  not  to  terrain-feature  edges  and  vertices.  With  each  edge-node,  associate  a  six-tuple  of  data  ele¬ 
ments  (Vi,V2,Rt,R2,P),P2).  The  Vj  are  the  two  vertices  of  the  edge.  The  assignment  of  vertices  to  the  two 
fields  V  i  and  V2  is  arbitrary,  but  once  assigned  is  fixed.  Once  the  vertices  are  assigned,  the  edge  becomes 
directed  from  Vi  to  V2,  Rt  is  the  region  (or  face  in  the  terminology  of  computational  geometry)  to  the  left  of 
tire  edge,  and  R2  is  the  region  to  tlx?  right.  Pi  is  a  pointer  to  tire  edge-node  which  is  adjacent  to  edge  V1V2  in 
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a  counterclockwise  rotation  about  V 1,  and  similarly  for  P2  with  respect  to  V2.  A  partial  listing  of  the  DCEL 
for  the  optimal-path  map  of  Figure  3  is  also  shown.  [Ref.  8] 

For  a  DCEL  representing  a  partition  with  n  vertices,  a  single  pa<~ '  t  time  0(n)  can  create  arrays  of 
headers  of  vertex  and  region  linked  lists,  so  that  strmgniforward  algorithms  can  retrieve  the  sequence  of  edges 
incident  on  a  vertex  or  enclosing  a  region,  in  time  proportional  to  the  number  of  edges  involved.  A  graph  in 
edge-list  form  can  be  transformed  to  a  DCEL  in  time  0{n).  [Ref.  8] 

An  extension  of  the  DCEL  allows  curved  edges,  as  well  as  piecewise-linear  ones,  to  be  represented. 
Additional  fields  for  each  edge-node  can  be  added  to  the  DCEL  to  represent  the  algebraic  form  of  the  curve 
and  to  represent  additional  parameters  necessary  to  specify  the  curve  analytically.  For  example,  if  a  curve  rep¬ 
resented  a  segment  of  a  hyperbola,  die  entry  in  the  first  additional  field  would  note  that,  and  the  second  addi¬ 
tional  field  would  contain  the  two  parameters  of  the  equation  of  a  hyperbola.  Two  points  on  tlie  hyperbola,  the 
endpoints  of  the  segment,  are  listed  in  the  DCEL,  so  the  hyperbola  segment  is  fully  specified. 

3.  The  Plane  Sweep  Paradigm 

Many  algorithms  in  computational  geometry  follow  the  plane  sweep  paradigm.  The  idea  is  to  process 
a  geometrical  structure  in  the  plane  in  an  ordered  fashion,  normally  ’:v  sweeping  an  imaginary  vertical  line 
from  left  to  right  from  event  point  to  event  point,  where  an  event  point  is  a  point  in  the  plane  at  which  some 
action  may  need  to  be  taken.  Two  data  structures  are  useful  in  conducting  a  plane  sweep,  an  event-point 
schedule  and  a  sweep-line  status.  At  any  point  alftflg  the  sweep  axis,  the  geometrical  structure  is  characterized 
by  a  status  which  is  the  relation  of  the  vciriva!  line  to  the  geometrical  structure.  For  example,  the  status  rnay 
be  an  ordered  list  of  line  segments  of  tlie  structure  which  intersect  the  .weep  line.  This  status  will  change  at  a 
finite  number  of  points  along  the  sweep  axis  for  a  finitely-describabSe  struclur..  These  changes  in  status  are 
the  places  at  which  the  problem  must  be  processed  or  analyzed.  Thcae  points  along  the  sweep  axis  arc  main¬ 
tained  in  the  event-point  schedule.  The  event-point  schedule  is  often  some  form  of  a  queue.  [Ref.  8] 

4.  Point-Location  in  the  Cartesian  Plane 

Linked  to  any  algoritlmi  that  partitions  tire  Cartesian  plane  in  order  to  represent  properties  of  points 
in  each  region  is  tiie  requirement  to  retrieve  those  properties  when  queried  about  any  point  in  tire  plane  specified 
by  its  coordinates.  Algorithms  thm  build  optimal-path  maps  are  partitioning  the  plane  into  regions  such  that 
each  region  contains  those  start  points  with  similarly -behaved  optimal  patlis  to  a  given  goal-point,  it  is  ucccs- 
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sary  to  determine  in  which  region  the  point  lies.  If  the  boundaries  between  regions  are  piecewise-Iinear  cur¬ 
ves,  there  arc  several  algorithms  from  computational  geometry  which  can  be  used  to  locate  a  point  in  the  planar 
partition. 

The  slab  method  of  point  location  in  a  planar  partition  draws  a  horizontal  line  through  each  vertex  of 
the  partition,  and  then  sorts  the  regions  (or  slabs)  lying  between  horizontal  lines  from  top  to  bottom  during 
preprocessing.  This  allows  location  of  the  point  within  a  slab  in  O(log  n)  time  by  use  of  bisection  search  based 
on  the  y-coordinatc  of  the  point,  where  n  is  the  number  of  vertices  in  the  partition.  Line  segments  which  com¬ 
prise  the  boundaries  of  the  partition  cross  through  each  slab.  Within  a  slab  they  can  be  ordered  from  left  to 
right  because  at  no  point  in  the  interior  of  a  slab  do  two  line  segments  intersect,  since  the  slabs  were  defined 
by  drawing  horizontal  lines  through  all  the  intersection  points  of  the  partition.  Then  bisection  search  can  be 
used  to  locate  the  point  horizontally  between  line  segments  within  the  slab  in  0(log  n)  time,  for  a  total  loca¬ 
tion  time  of  0(log  n + log  n)  =  0(log  n).  Two  disadvantages  to  this  method  are  the  requirement  for  preprocess- 
ing  lime  and  storage  space.  Preparata  and  Shamos  show  how  to  reduce  the  basic  0(n  log  n)  preprocessing 
time  to  0(n“)  using  a  plane  sweep  approach,  but  the  algorithm  requires  at  worst  0(n  )  space.  [Ref.  8] 

A  second  nnint-Jocation  method  Is  the  chain  method.  Instead  of  dividing  the  planar  graph  horizon¬ 
tally  with  slabs,  it  finds  vertical  chains,  or  connected  line  segments,  of  edges,  which  are  monotone  with  respect 
to  the  y-axis,  i.e.,  such  that  no  two  points  on  the  chain  have  the  same  y-coordinate.  It  then  constructs  two  bi¬ 
nary  search  trees,  the  first  having  those  chains  as  nodes  and  the  second  having  segments  of  chains  as  nodes. 
The  two  trees  can  be  traversed  in  O(log2  n)  time  to  locate  a  point.  A  DCEL  can  be  preprocecsed  in  0(n  log  n) 
lime  into  the  two  binary  search  trees,  which  take  at  worst  O(n)  space.  [Ref.  8] 

Another  point-location  method  is  the  triangulation  refinement  method.  A  set  of  connected  line  seg¬ 
ments  is  said  to  be  triangulated  if  each  vertex  is  connected  by  a  line  segment  with  at  least  two  other  vertices, 
i.e.,  the  line  segments  all  form  triangles.  The  planar  partition  is  triangulated  in  0(n  log  n)  time  by  standard 
methods  from  computational  geometry,  and  a  hierarchy  of  triangulations  is  constructed  upon  which  to  search. 
This  method  leads  to  O(log  n)  query  time,  0(n  log  n)  preprocessing  time,  and  O(n)  storage.  [Ref.  8] 

An  extension  of  the  chain  method,  tire  bridged  chain  method,  uses  an  elegant  method  that  permits 
search  in  O(constant)  lime  for  subsequent  searches,  after  a  iiigber  cost  for  a  first  search.  It  happens  that  tire 
chain  method  meets  the  conditions  for  application  of  lire  bridging  technique,  and  so  bridging  is  used  to  ac- 
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cumulate  information  during  the  search  process.  This  technique  brings  the  chain  method  to  efficiency  com¬ 
parable  with  the  triangulation  refinement  method.  [Ref.  8] 

Although  the  above  two  methods  achieve  the  theoretically  optimum  worst-case  bounds,  there  may 
be  sub-optimal  methods  which  afford  better  practical  perfonnance.  Specifically,  the  trapezoid  method,  which 
could  be  considered  an  extension  of  the  slab  method,  gives  an  0(log  n)  query  which  always  succeeds  in  fewer 
than  4|" log  nl+  3  tests,  and  uses  0(n  log  n)  storage  ar  preprocessing  time.  Actually,  average-case  storage 
may  be  0(n).  This  method  has  the  additional  property  that  it  may  be  extended  to  curvilinear  edges,  so  it  may 
be  especially  useful  in  our  application  since  instead  of  approximating  curves  piecewise-linearly,  they  may  be 
represented  exactly  by  their  analytical  form.  [Ref.  8] 

A  problem  with  the  slab  method  was  the  0(n*)  worst-case  space  complexity,  where  n  is  the  number 
of  vertices  of  tire  graph  representing  the  planar  partition.  This  problem  was  due  to  the  possibility  that  edges 
could  span  most  of  the  horizontal  slabs,  each  such  edge  needing  to  be  segmented  into  0(n)  fragments.  In  the 
trapezoid  method,  it  can  be  shown  that  no  more  than  2  log  n  fragments  will  ever  be  needed  for  aoy  edge,  so 
no  more  than  0(n  log  n)  space  is  required.  The  trapezoid  method  defines  a  trapezoid  as  having  two  horizon¬ 
tal  sides  and  two  other  sides  which  may  be  unbounded,  or  else  if  they  exist  are  edges  of  the  graph  not  inter¬ 
rupted  by  vertices.  The  basic  operation  of  tlie  algorithm  is  to  split  a  trapezoid  into  subordinate  trapezoids.  The 
progress  of  the  splitting  algorithm  is  paralleled  by  the  building  of  a  balanced  binary  search  tree  which  repre¬ 
sents  a  hierarchy  of  subordinate  trapezoids.  This  tree  can  then  be  searched  to  locate  a  point  in  a  trapezoid. 
Figure  4  (adapted  from  Preparata  and  Sham  os  [Ref.  8])  sliows  an  example  trapezoid  with  its  corresponding 
search  tree. 

The  splitting  operation  for  the  trapezoid  method  proceeds  by  finding  the  median  y-coordinale  among 
the  vertices  contained  in  the  current  trapezoid  T  and  dividing  T  into  two  "slices"  Tt  and  T2  by  drawing  a 
horizontal  line  through  tlie  median  vertex.  Then  those  edges  which  intersect  the  top  or  bottom  horizontal  side 
of  T  are  scanned  from  left  to  right,  and  lire  first  edge  which  also  intersects  the  newly  drawn  horizontal  line, 
i.c.,  which  spans  T 1  or  T2,  defines  a  new  trapezoid  T3.  The  scan  continues  until  all  edges  which  span  Tt  orTz 
are  found,  with  a  new  trapezoid  being  generated  for  each  spanning  edge.  Note  that  edge  ei  defines  the  first 
new  trapezoid  Tj  in  Figure  4  because  it  spans  the  top  and  median  lines  of  T.  T3  will  not  need  to  be  further  split 
because  there  are  no  vertices  contained  in  it.  Spanning-edge  e2  is  found  next,  and  creates  T6.  Finally  e3  is 
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found,  creating  T4.  No  other  spanning  edges  ate  found,  so  T3  and  T7  are  also  defined.  T4,  T5,  T&  and  T7  all 
contain  vertices  of  the  graph  in  their  interiors,  so  they  will  need  to  be  split  further  in  subsequent  iterations  of 
the  algorithm.  Triangular  nodes  of  the  search  tree  represent  horizontal  splits  at  graph  vertices,  while  circular 
nodes  represent  the  definition  of  new  trapezoids  by  spanning  edges.  There  will  be  n-2  triangular  nodes  of  the 
tree,  one  for  each  except  the  left  and  right  extreme  vertices  of  the  graph.  Edges  may  form  the  sides  of  more 
than  one  trapezoid,  however;  in  fact  they  may  be  fragmented  into  as  many  as  2  log  n  segments,  as  stated  above. 
Thus  the  search  tree  may  have  as  many  as  0(u  log  n)  nodes,  which  is  the  worst-case  space  complexity.  The 
tree  corresponding  to  the  trapezoids  found  in  Figure  4  is  also  shown. 

The  depth  of  the  balanced  search  tree  can  be  shown  to  be  no  more  than  4  fi log  nl+  3,  so  a  search  of 
the  tree  will  take  no  mote  than  that  many  steps.  Thus  the  worst-case  time  complexity  to  locate  a  point  in  the 
planar  partition  is  0(log  n).  Since  there  are  0(n)  edges  and  each  edge  may  be  segmented  into  Oflog  n)  frag¬ 
ments,  the  time  required  to  process  the  edges  is  0(n  log  n),  while  both  the  median-finding  and  the  tree-balanc¬ 
ing  may  be  done  in  0(n  log  n)  time.  Thus  the  preprocessing  required  is  0(n  log  n). 

An  added  advantage  which  could  be  useful  to  our  research  is  that  the  trapezoid  method  can  be  ex¬ 
tended  in  some  cases  to  finding  a  point  among  edges  which  are  not  straight-line  segments.  This  can  be  done 
if  fust,  the  curves  can  be  expressed  as  a  single-valued  function  of  one  of  the  coordinates,  and  second,  if  it  can 
be  determined  in  constant  time  whether  a  point  is  on  one  side  or  the  other  of  the  curve. 

5.  Intersections  Among  Line  Segments  in  the  Cartesian  Plane 

A  common  operation  of  the  algorithms  proposed  in  Chapter  VI  is  to  find  intersections  between  two 
piecewisc-linear  curves.  It  is  thus  important  to  find  efficient  methods  of  doing  this  operation.  The  intersection 
of  two  piecewise-linear  curves  with  p  and  q  segments  respectively  would  take,  using  the  naive  approach  which 
compares  each  segment  of  one  curve  with  each  segment  of  the  other,  0(pq)  line  segment  intersections,  so  it 
is  important  to  find  belter  ways  of  doing  the  operation. 

Prcparata  and  Sham  os  present  an  algorithm  to  find  all  intersections  among  n  line  segments  by  per¬ 
forming  a  plane  sweep  along  the  x-axis.  At  any  point  on  the  x-axis,  a  vertical  line  imposes  a  total  order  on 
those  line  segments  it  intersects.  This  order  is  recorded  in  the  sweep-line  status.  As  the  vertical  line  sweeps  to 
the  right  from  intersection  point  to  intersection  point,  new  line  segments  may  be  added  to  the  ordering,  and 
old  ones  deleted,  but  if  any  adjacent  pair  of  line  segments  changes  order,  wliich  is  detected  by  a  change  in  tire 
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sweep-line  status,  an  intersection  of  those  segments  must  have  occurred.  Thus,  any  line  segment  which  is  added 
to  the  ordering  is  checked  for  intersection  with  the  segment  immediately  above  and  below  it  by  checking  if 
the  relative  order  changes  at  the  point  along  the  x-axis  where  the  first  of  the  two  segments  will  be  deleted.  This 
approach  can  detect  k  intersections  among  n  line  segments  where  n  is  p+q  in  time  0<(n+k)  log  n).  In  our  domain 
however,  any  two  homogeneous-behavior-region  boundaries  will  intersect  in  at  most  one  point,  becausewhen 
any  two  boundaries  intersect,  a  third  boundary  will  begin  and  the  other  two  will  end.  Therefore  we  could  use 
a  simplification  of  the  above  algorithm  which  will  operate  in  0(n  log  n)  time.  [Ref.  8] 

Intersection  calculation  for  piecewise-linear  curves  with  monotonic  curvature  can  exploit  these 
properties.  Several  algorithms  of  uncertain  worst-case  complexity  seem  to  provide  good  empirical  results.  One 
in  particular  [Ref.  9]  proceeds  by  constructing,  in  0(p)  time,  a  bounding  box  for  the  first  piecewise  linear 
curve,  and  then  checking,  in  O(q)  time,  which  portion  of  the  secood  curve,  if  any,  intersects  (be  bounding  box. 
The  intersecting  portion  of  the  second  curve  usually  contains  only  a  small  fraction,  call  it  kt,  of  the  whole 
curve,  although  it  is  at  this  point  that  the  analysis  becomes  imprecise  because  kj  does  not  depend  on  p  or  q, 
but  on  the  curvature  and  relative  positions  of  the  two  curves.  In  any  case,  the  next  step  is  to  reverse  the  roles 
of  the  two  curves  and  create  another  bounding  box  about  the  kiq  line  segments  of  the  second  curve,  in  Ofkiq) 
time.  The  first  curve  is  intersected  with  the  new  bounding  box  in  0(p)  time,  finding  k2p  segments  which 
traverse  the  new  box.  The  algorithm  proceeds  recursively  as  above,  terminating  when  one  of  the  bounding 
boxes  contains  only  one  line  segment.  At  this  point,  the  next  check  of  the  other  curve  will  yield  the  exact  in¬ 
tersection  point.  A  rough  approximation  of  the  time  complexity  of  this  rugorithm,  if  it  is  assumed  for  simplicity 
that  at  each  stage  tlie  size  of  the  curve  is  reduced  by  the  same  fraction  k,  isT  =  ((l+k)q  +  2p)/(l-k)  + 1.  Thus 
this  algorithm  has,  assuming  0<k<l,  time  complexity  0(q+2p)  =  0(q+p)  =  0(n).  This  algorithm  will  not  con¬ 
verge  if  at  any  stage  the  bounding  box  of  each  partial  curve  completely  contains  the  other  partial  curve.  But  a 
simple  check  during  each  iteration  to  ensure  that  the  sizes  of  the  two  curves  are  in  fact  decreasing  will  allow 
the  method  to  proceed  if  it  is  converging.  If  it  fails  this  test,  a  full  O(pq)  test  of  the  two  curves  can  be  used  in¬ 
stead. 

6.  Voronoi  Diagrams 

A  technique  in  computational  geometry  that  has  been  of  use  in  some  algorithms  pertaining  to  op¬ 
timal-path  maps  is  Voronoi  diagram  construction  [Ref.  8].  A  Voronoi  diagram  Vor(S)  with  respect  to  a  set  of 
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points  S  in  a  plane  is  the  partition  of  the  plane  such  that  each  region  contains  the  points  with  the  same  nearest 
neighbor  in  S.  Figure  5  shows  a  typical  Voronoi  diagram.  One  method  for  constructing  shortest-path  maps 
(i.e.,  an  optimal-path  map  for  binary  terrain),  uses  an  extension  of  Voronoi-diagram  methodology  to  plot  ap¬ 
proximations  of  the  boundaries  between  homogeneous-behavior  regions  [Ref.  4].  It  reduces  the  problem  of 
constructing  the  planar  partition  to  that  of  finding  a  Voronoi  diagram  for  the  vertices  of  an  obstacle,  where  the 
costs  of  optimal  paths  from  each  vertex  isknowa  Instead  of  bisectors  between  two  vertices  which  are  straight 
lines  exactly  half-way  between  them  as  described  below,  this  method  constructs  bisectors  which  are  either 
lines  or  hyperbola  branches,  depending  on  the  nature  of  the  paths  from  the  two  vertices.  Then  the  Voronoi 
diagrams  of  single  obstacles  are  merged  to  form  the  complete  OPM. 

Some  observations  about  Voronoi  diagrams  lead  to  an  initial  construction  method.  Between  two 
points  Pi  and  P2  in  the  plane,  the  set  of  points  closer  to  P|  than  to  P2  are  the  points  in  a  half-plane  containing 
Pi  defined  by  the  perpendicular  bisector  of  the  line  segment  P1P2.  Among  a  set  S  of  n  points  in  the  plane,  the 
set  of  points  closer  to  a  point  Pi  than  to  any  other  point  in  S  is  the  intersection  of  n-1  half-planes  each  contain¬ 
ing  Pi  defined  by  the  perpendicular  bisectors  of  the  line  segments  PiPj.  From  this  observation,  a  brute-force 
method  of  constructing  a  Voronoi  diagram  would  be  simply  to  construct  each  of  the  n  polygons  about  each 
point  in  S.  Since  n  half-planes  can  be  intersected  with  each  other  in  0(n  log  n)  time  by  a  divide-and-cooquer 
approach,  this  approach  takes  lime  0(n  log  n).  [Ref.  8) 

A  more  efficient  approach  for  constructing  Voronoi  diagrams  which  also  uses  the  divide-and-con- 
quer  paradigm  can  be  summarized  as  follows.  First,  partition  S  into  two  sets  Si  and  S2  of  roughly  equal  size 
according  to  wliether  the  x-coordinale  of  each  point  is  less  than  or  greater  than  the  median  x-coordinale  of 
points  in  S.  Then,  construct  VorfSj)  and  Vor(S2)  recursively,  and  finally,  merge  Vor(St)  and  VorfS2)  to  ob¬ 
tain  Vor(S).  Partitioning  S  takes  0(n)  time  for  a  set  S  of  size  n  using  a  standard  median-finding  algorithm  and 
the  merging  step  takes  0(n)  time.  If  the  entire  algorithm  can  be  performed  in  T(n)  steps,  the  construction  of 
both  subordinate  Voronoi  diagrams  in  step  two  takes  approximately  2T(n/2)  time.  So  the  recurrence  relation 
T(n)  =  2T(n/2)  +  0(n)  describes  the  algorithm,  which  when  solved  gives  that  T(n)  is  0(n  log  n). 

The  merging  step  is  tlie  heart  of  the  algorithm,  and  is  accomplished  as  follows.  Because  the  map  is 
partitioned  such  that  S 1  and  S2  will  lie  on  opposite  sides  of  a  vertical  line,  it  can  be  shown  that  there  is  a  chain 
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<J,  i.c.,  a  sequence  of  connected  line  segments,  which  is  monotonic  with  respect  to  the  y-axis,  (i.e.,  no  two 
points  of  the  chain  have  the  same  y-coordinate)  that  also  partitions  the  plane  with  Si  and  S2  on  opposite  sides 
of  a  such  that  the  union  of  the  portion  of  Vor(S  1)  which  is  left  of  <J  and  the  portion  of  Vor(S2)  which  is  right 
of  <7  yields  VorfS).  In  fact  this  chain  (7  can  be  constructed  in  linear  time,  so  the  recurrence  relation  staled 
above  holds,  and  the  construction  of  a  Voronoi  diagram  can  be  done  in  0(n  log  n)  time.  [Ref.  8] 

Generalizations  of  Voronoi  diagrams  have  been  presented  which  partition  the  plane  into  sets  of  points 
closest  to  a  set  of  line  segments  [Ref.  10],  or  which  base  their  distance  function  on  metrics  other  than  the 
Euclidean  metric  [Ref.  II].  Since  OPMs  for  homogeneous-cost  areas  can  be  thought  of  as  Voronoi  diagrams 
with  a  different  metric  for  each  homogeneous-behavior  region,  the  latter  wo*  seems  promising.  Currently, 
however,  only  several  simple  metrics  such  as  Lj  and  Loohave  been  considered,  so  more  research  in  this  area 
is  necessary  before  OPMs  of  the  type  we  are  considering  can  be  constructed  with  this  approach.  Weighted 
Voronoi  diagrams  [Ref.  12]  assign  a  weight  to  each  point  about  which  regions  are  computed.  This  concept 
might  appear  useful  in  constructing  OPMs,  but  is  not.  Instead  it  applies  to  a  problem  in  which  a  mobile  agent 
travels  at  different  speeds  depending  on  which  terrain-feature  vertex  it  just  crossed. 

What  is  needed  in  constructing  OPMs  for  the  binary  case  is  a  type  of  generalized  Voronoi  diagram 
in  which  the  weight  is  the  cost-rate  of  the  region  in  which  an  obstacle  vertex  lies,  and  an  offset  of  the  initial 
weight  at  the  vertex  represents  the  cost  of  the  optimal  path  from  the  vertex.  This  is,  in  essence,  what  the  algo¬ 
rithm  of  Aronov  [Ref.  13]  computes.  This  algorithm  allows  points  in  the  Voronoi  set  to  be  given  an  initial  of¬ 
fset  weight.  Knowing  that  bisectors  between  such  points  are  hyperbolas  (or  in  the  degenerate  case,  lines),  they 
can  be  plotted  just  as  in  the  basic  Voronoi  diagram  algorithm.  The  key  element  of  the  method  is  the  proof  that 
a  dividing  chain  can  be  constructed  between  two  Voronoi  diagrams  as  discussed  above,  which  now  can  con¬ 
tain  hyperbola  segments  as  well  as  line  segments.  This  allows  smaller  generalized  Voronoi  diagrams  to  be 
merged  into  larger  ones,  which  is  the  foundation  of  the  divide-and-conquer  approach  used. 

C.  DEFINITIONS  OF  RELEVANT  FREE-SPACE  PATH-PLANNING  PRODLEMS 

This  thesis  addresses  problems  where  the  mobile  agent  is  of  negligible  size  with  respect  to  the  surround¬ 
ing  terrain,  where  terrain  is  two-dimensional  free  space  with  fixed  terrain  features,  where  tlte  environment  is 
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stable  and  knowledge  about  it  is  complete,  and  where  the  optimality  criterion  is  to  minimize  a  cost  function 
which  is  linear  in  path  length. 

A  simplified  version  of  this  problem  has  been  called  by  Lozano  and  Wesley  [Ref.  1]  and  Brooks  [Ref. 

14]  the  FIND-PATH  Problem,  and  by  Mitchell  [Ref.  15]  the  OBSTACLE-AVOIDANCE  Problem.  This 

simplified  problem  seeks  any  feasible  path  in  terrain  consisting  of  impassable  obstacles  on  a  homogeneous- 

cost  background.  An  important  extension  to  the  FIND-PATH  Problem  includes  the  optimality  criterion  that 

the  resulting  path  be  the  shortest  among  all  feasible  paths.  It  is  called  the  OBSTACLE-AVOIDANCE 

SHORTEST-PATH  Problem,  or  simply  the  SHORTEST-PATH  Problem. 

OBSTACLE-AVOIDANCE  SHORTEST-PATH  Problem:  Given  a  mobile  agent  A  of  negli¬ 
gible  size  with  respect  to  tlie  environment,  an  environment  E  consisting  of  impassable  obs< ‘teles  at 
fixed  and  known  locations  on  a  homogeneous-cost  background,  and  motion  objective  O  consisting 
of  the  translation  of  A  to  a  specified  goal  point  in  the  environment,  find  a  continuous  path  it  for  A 
amidst  E  that  achieves  objective  O  such  that  its  length  is  minimal  among  all  feasible  paths,  or  report 
that  no  feasible  path  exists. 

Realistic  terrain  for  large-scale  cross-country  path-planning  can  rarely  be  modelled  as  binary  (i.e., 

obstacles  on  a  homogeneous-cost  background).  A  more  useful  assumption  is  that  terrain  can  be  modelled  as 

homogeneous-cost  regions.  The  map  is  consists  of  regions,  each  assigned  a  value  representing  the  cost  rate  to 

the  agent  to  traverse  the  region.  The  weighted-region  problem  is  a  generalization  of  the  obstacle-avoidance 

shortest-path  problem  which  defines  terrain  as  homogeneous-cost  regions. 

WEIGHTED-REGION  Problem:  Given  a  mobile  agent  A  of  negligible  size  with  respect  to  en¬ 
vironment  E,  E  consisting  of  a  partition  of  the  plane  into  fixed  homogeneous-cost  regions  of  known 
position,  and  motion  objective  O  consisting  of  the  translation  of  A  to  a  specified  point  in  environ¬ 
ment  E,  find  a  continuous  path  K  for  A  amidst  E  that  achieves  objective  O  such  that  the  path  in¬ 
tegral  of  the  cost  is  minimal,  or  report  that  no  feasible  path  exists. 

Tire  U.S.  Army  Engineer  Waterways  Experiment  Station,  the  U.S.  Army  Engineer  Topographic 
Laboratories  (ETL)  and  die  Defense  Mapping  Agency  (DMA)  currently  can  produce  such  cost-rate  maps  of 
environments  E  using  a  program  called  Army  Mobility  Model  (AMM),  for  portions  of  the  earth  for  which 
digitized  terrain  data  is  available.  This  data  includes  not  only  elevation  data,  but  cultural,  vegetation,  and  soil 
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terrain  is  subdivided  according  to  the  maximum  speed  with  wliich  the  given  vehicle  could  be  expected  to 


traverse  the  terrain. 
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If  an  application  will  require  repeated  solutions  of  the  shortest-patb  or  weighted-region  problems,  it  may 

be  more  efficient  to  construct  an  optimal-path-map  which  represents  optimal  paths  to  a  given  goal  point  from 

all  start  points  in  the  plane.  If  the  output  map  represents  solutions  to  the  shortest-patb  problem,  it  is  called  a 

shortest-path-map.  Some  authors  use  shortcst-path-map  to  refer  to  maps  of  the  weighted-region  problem  as 

well,  allowing  the  word  shortest  to  mean  shortest  with  respect  to  a  specified  cost  function.  We  prefer  the  term 

optimal-path-map,  however,  to  emphasize  its  basis  in  the  weighted-region  problem. 

FIXED-GOAL  OPTIMAL-PATH-MAP  Problem:  Given  mobile  agent  A  of  negligible  size  with 
respect  to  environment  E,  E  consisting  of  a  partition  of  the  plane  into  fixed,  homogeneous-cost 
regions  of  known  position,  and  a  set  of  motion  objectives  6  which  are  to  translate  agent  A  from 
each  of  the  continuum  of  start  points  S  in  the  plane  to  a  goal  point  G,  represent  tire  set  II  of  con¬ 
tinuous  paths  for  A  in  E  that  achieves  objectives  Oi  in  0  such  that  the  path  integral  for  each  Tti  is 
minimal  over  all  paths  from  start  point  Si  to  G,  or  report  that  no  feasible  path  exists. 


D.  TYPES  OF  PATH  ERRORS 


Several  classes  of  errors  may  occur  in  algorithms  which  look  for  optimal  paths.  Each  algorithm  is  based 
on  a  model  of  the  path-planning  domain  with  its  own  representation  of  reality,  and  operations  manipulate  that 
representation  to  produce  a  solution.  For  example,  terrain  in  some  models  is  represented  by  imposing  a  grid 
on  the  map  and  assigning  a  cost  to  each  cell  of  the  grid,  wliile  in  some  models  terrain  is  represented  by  polygons 
with  an  assigned  cost.  Errors  may  occur  either  because  of  inaccuracies  in  operations  within  the  model  or  be¬ 
cause  of  inaccuracies  in  the  model  compared  with  the  real-world  domain.  The  first  class  below  are  errors  of 
the  former  type,  while  the  second  and  third  classes  are  errors  of  the  latter  type. 

1.  Cost  of  Model  Computed  Path  versus  Cost  of  Model  Optimal  Patli 

Path-planning  algorithms  execute  within  the  context  of  their  model  of  real-world  terrain.  If  an  algo¬ 
rithm  produces  a  solution  path  which  has  a  computed  cost  greater  than  the  minimum  cost  of  some  other  path 
represented  within  the  model,  the  algorithm  has  produced  a  model  sub-optimal  path.  Such  asolution  may  occur 
cither  intentionally  or  unintentionally.  Some  algorithms  terminate  when  a  candidate  solution  is  guaranteed  to 
be  witliin  some  bound  of  the  true  model  optimal  solution,  thus  saving  processing  time  at  the  expense  of  ac- 
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an  algorithm  which  produces  solutions  with  litis  kind  of  error  is  called  simulated  anncalling.  It  uses  stochas¬ 


tic  methods  to  determine  when  a  candidate  solution  has  a  high  probability  of  being  good  enough  [Ref.  18].  Er- 
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rors  of  this  type  also  occur  because  of  numerical  errors  in  the  mathematical  operations  performed  by  the  al¬ 
gorithm.  Standard  numerical  analysis  techniques  can  be  used  to  study  these  errors  and  attempt  to  reduce  them. 

2.  Cost  of  Model  Optimal  Path  versus  Cost  of  Real-World  Optimal  Path 

When  the  cost  of  the  optimal  path  within  the  model  is  different  from  the  actual  cost  of  a  path  between 
the  same  two  points  in  the  real  world,  an  error  of  the  second  class  has  occurred.  Even  the  actual  measurement 
of  a  path  cost  is  only  an  approximation  of  reality,  so  any  model  produces  at  least  some  small  error  of  this  kind. 
The  amount  of  tills  kind  of  error  produced  is  an  important  consideration  in  choosing  among  algorithms.  For 
example,  as  discussed  in  Section  E  below,  the  wavefront  propagation  algorithm  may  produce  solutions  which 
ate  optimal  in  its  grid-based  model,  but  which  have  as  much  as  7.6%  greater  cost  than  an  actual  path  between 
the  same  two  points  as  measured  in  the  real  world. 

3.  Location  of  Model  Optimal  Path  versus  Location  of  Real-World  Optimal  Path 

A  model  optimal  path  could  still  be  a  valuable  representation  of  a  real-world  optimal  path  despite  a 
larger  cost  than  the  true  optimal  cost  if  its  qualitative  behavior  was  similar  enough  to  the  path  it  represented. 
But  algorithms  may  produce  solutions  which  follow  quite  different  routes  than  the  real-world  optimal  path. 
As  discussed  by  Mitchell  and  Kiersey  [Ref.  19],  the  grid-based  model  upon  which  wavefront  propagation  (see 
Section  E  below)  is  based  allows  for  multiple  paths  with  the  model  optimal  cost,  so  only  the  details  of  the  al¬ 
gorithm  implementation  determine  which  one  is  reported  as  the  solution,  and  that  reported  solution  may  dif¬ 
fer  markedly  from  the  true  optimal  path.  This  type  of  error  may  or  may  not  be  important  depending  on  the 
application  to  which  the  results  will  be  applied. 

E.  RELEVANT  OPTIMAL-PATH  PLANNING  RESEARCH 

A  taxonomy  for  categorizing  fiee-space  path-planning  methods  is  presented  in  Figure  6.  Algorithms  for 
frc  -space  path  planning  generally  transform  an  infinite  search  space  into  a  finite  one  by  eliminating  all  but  a 
finite  number  of  candidate  paths,  and  then  searcliing  this  finite  space  using  standard  techniques  such  as  branch- 
and-bound  or  A*  search.  Two  distinct  ways  used  to  effect  this  transformation  to  a  finite  search  space  are  map 
discretization  and  spatial  reasoning. 
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1.  Map  Discretization  -  Wavefront  Propagation 

Map  discretization  methods  approximate  the  terrain  by  imposing  a  tesselation  on  the  map  and 
categorizing  each  cell  according  to  the  terrain  it  overlays,  and  allow  travel  only  between  centers  of  grid  cells. 
Alternate  representations  are  possible,  for  example,  where  travel  is  allowed  between  comers  of  cells.  Since 
there  are  a  finite  number  of  cells,  there  are  a  finite,  though  large,  number  of  candidate  paths  (assuming  cycling 
is  prevented).  A  method  popular  for  its  simplicity  is  called  wavefront  propagation  (see  Figure  7)  [Ref.  15], 
[Ref.  20].  The  terrain  is  approximated  by  a  square  tesselation  of  the  map,  and  paths  are  approx!mated  by  al¬ 
lowing  motion  only  from  the  center  of  a  cell  to  the  center  of  an  adjacent  cell.  Eight-neighbor  adjacency  is 
usually  used,  meaning  that  from  a  cell,  the  agent  may  move  to  any  of  the  four  perpendicularly  adjacent  cells 
or  to  any  of  the  four  diagonally  adjacent  cells.  Because  of  the  restrictions  on  directions  of  movement,  eight- 
neighbor  wavefront,  propagation  has  as  much  as  7.6%  inaccuracy  in  that  a  reported  solution  may  cost  as  much 
as  7.6 %  more  than  the  real-world  optimal  path  [Ref.  20].  Normally  Dijkstra’s  algorithm  (brand>-and-bound 
search)  is  used  to  expand  in  all  directions  from  the  start  point  until  the  goal  is  first  reached.  The  name  wavefront 
propagation  is  used  because  of  the  analogy  of  the  expansion  of  a  circular  wave  in  water. 

The  implementation  of  wavefront  propagation  reported  by  Ricbbourg  [Ref.  21]  is  a  variation  of 
Dijkstra’s  algorithm  which  models  the  expansion  of  the  wavefront  explicitly.  The  basic  mechanism  is  that  time 
is  incremented  in  fixed  units,  and  at  each  time  increment  the  wavefront  is  propagated  outward  as  far  as  it  can 
travel  through  each  cell  currently  on  the  wavefront.  Each  cell  which  is  reached  by  the  wavefront  is  added  to 
tire  wavefront  list,  and  when  the  cell’s  cost  has  been  decremented  below  zero  it  is  dropped  off  the  wavefront 
list.  During  each  iteration,  cells  tlurough  which  tire  wavefront  has  fully  passed  will  propagate  the  wave  to  each 
of  their  neighbors.  If  the  neighbor  cell  has  not  yet  been  reached  by  the  wavefront  a  back-pointer  is  set  back  to 
the  cell  on  the  wavefront  and  the  neighbor  cell’s  cost  is  decremented  according  to  how  far  the  wavefront  can 
travel  through  it  in  a  unit  of  time.  If  the  neighbor  cell  has  already  been  reached  by  another  cell  on  the  wavefront, 
no  action  will  be  taken  unless  the  neighbor  cell’s  cost  could  be  decremented  frmlier  by  the  currently  propagat¬ 
ing  cell  than  it  was  decremented  by  the  previous  cell.  In  that  case,  the  pointer  is  changed  to  point  to  the  cur¬ 
rent  cell  and  the  cost  is  set  accordingly. 


30 


•1 


| 

9 

m 

mm 

In 

D 

l 

B 

wm 

n 

| 

i 

| 

j 

B 

go 

| 

i 

B 

a 

1 

| 

i 

n 

B 

! 

i 

B 

B 

i 

i 

B 

B 

B 

6  7  R  9  10 


.1 

10 


KCY: 

5  it  •  i  a  r I • point , 

Hawher  it  itniiniMf;  cotl  of  cell 
Solid  trio*  if  bac&poinicr  for  cell  which  hit 
been  pvl  on  wavtfnmt  bccavic  Coil  <■  0. 
Dashed  alto*  if  backpointer  for  cell  *h{ch  If 
nol  pel  on  wavefront  bat  hat  been  reached  bp 
wavefront , 


Figure  7 


Wavefront  Propagation 


If  cells  are  square  and  have  unit  dimensions,  time  could  be  advanced  in  increments  such  that  it  would 
take  1  time  unit  for  the  wave  to  pass  through  a  cell  of  unit  cost  in  au  orthogonal  direction  and  VT  time  units 
in  a  diagonal  direction.  For  a  cell  with  a  cost  of  c,  the  wave  will  take  c  and  c-VT  time  units  respectively.  Al¬ 
ternately,  we  will  adopt  the  convention  that  time  is  incremented  in  units  of  \  2,  so  that  the  wave  wiU  progress 
V7/c  units  of  distance  through  a  ceil  of  cost  c  in  the  orthogonal  direction  in  one  iteration,  and  1/c  distance  in 
the  diagonal  direction  in  one  iteration.  This  convention  provides  that,  for  cells  of  integral  cost,  diagooal  ex¬ 
pansion  of  the  wave  will  always  end  inside  the  cell  or  at  its  edge,  never  overflowing  into  the  next  cell,  so  it  is 
only  in  the  orthogonal  direction  that  it  is  necessary  to  check  for  overflow.  Thus  we  decrement  the  original  cost 
associated  with  a  cell  by  1  or  by  VT  at  each  iteration,  and  when  the  remaining  cost  is  less  than  zero,  we  know 
that  the  wave  has  passed  completely  through  it.  Figure  7  illustrates  the  mechanics  of  the  wavefront  propaga¬ 
tion  algorithm.  The  figure  shows  a  sequence  of  snapshots  of  the  algorithm,  where  the  remaining  cost  of  each 
cell  is  noted  inside  the  cell,  and  arrows  represent  pointers  to  each  parent  cell.  The  arrows  are  solid  when  the 
cell  has  been  added  to  the  wavefront,  and  dotted  when  the  cell  is  not  yet  on  the  wavefront  but  has  a  back¬ 
pointer  assigned. 

For  a  map  of  m  cells,  the  worst-case  time  complexity  of  Dijkstra’s  algorithm  is  0(m  log  m),  [Ref. 
IS],  or  if  we  consider  the  two-dimensional  nature  of  the  input  map,  say  of  size  n  by  n  cells,  the  complexity  is 
0(n"  log  n).  This  version  does  not  depend  on  the  costs  of  cells  on  the  map.  But  for  the  version  used  by  Rich- 
bourg,  time  complexity  is  also  a  function  of  initial  costs  of  the  cells.  Each  cell  will  remain  on  the  wavefront 
until  its  initial  cost  c  is  decremented  below  zero.  The  cell's  cost  will  be  decremented  by  1  or  V”T"  at  each 
iteration,  so  each  cell  will  remain  on  the  wavefront  for  0(c)  iterations.  Each  iteration  that  a  cel!  is  on  the 
wavefront,  its  eight  neighbors  will  be  checked  to  see  if  the  shortest  path  yet  to  the  neighbor  cell  is  through  the 
cell  being  considered,  or  through  some  already-processed  cell.  Thus  in  the  worst-case  where  ail  cells  have  a 
cost  Cm«,  if  we  assume  that  there  is  some  upper  bound  on  tlie  cost  of  cells,  the  worst-case  time  complexity  is 
0(Cm«x  m).  In  terms  of  an  n  by  n  input  map,  the  worst-case  time  complexity  is  0(Cm*x  n2).  We  must  for  theoreti¬ 
cal  reasons  make  the  assumption  that  there  is  an  upper  bound  on  the  magnitude  of  Cm»x,  because  if  cm»  is  un¬ 
bounded,  and  as  usual  is  represented  in  log  cm«  bits,  we  have  that  the  size  of  the  input  map  is  I  «=  0(!og  Cmcx), 
or2!  =  Cmax.  Thus  tire  worst-case  time  complexity  would  be  0(2fm).  As  explained  in  [Ref,  22],  this  type  of  al¬ 
gorithm  has  pseudo-polynomial  tunc  complexity,  i.e„  it  is  polynomial  if  ihc  input  size  is  bounded,  but  ex- 
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ponential  if  the  input  size  is  allowed  to  be  unbounded.  Both  versions  of  wavefront  propagation  have  space 
complexity  of  O(m). 

Dijkstra’s  algorithm  examines  paths  in  all  directions  from  the  start  point,  regardless  of  which  are  like¬ 
ly  to  lead  to  the  goal  point  quickest  But  extending  the  algorithm  to  A*  search  by  introducing  an  evaluation 
function  gives  large  increases  in  execution  speed  by  focusing  the  search  on  paths  which  seem  to  be  proceed¬ 
ing  in  the  best  directions.  The  evaluation  function  used  in  the  A*  version  of  wavefront  propagation  measures 
the  Euclidean  distance  from  the  cell  currendy  being  considered  to  the  goal  cell.  Mitchell  and  Kiersey  [Ref. 
19]  report  an  increase  in  speed  for  A*  search  over  Dijkstra’s  algorithm  of  1.5  to  20  times. 

Increased  resolution  of  the  tesselation  will  not  reduce  the  worst-case  inaccuracy  of  reported  solutions 
below  the  7.6%  upper  bound.  Tliis  inaccuracy,  called  digitization  bias,  arises  because  of  the  discrete  ap¬ 
proximation  of  paths.  The  only  way  to  reduce  the  upper  bound  on  error  caused  by  digitization  bias  is  to  in¬ 
crease  the  number  of  possible  directions  the  mobile  2 gent  is  allowed  to  travel.  Sixteen-neighbor  wavefront 
propagation,  for  example,  allows  paths  between  a  cell  and  the  sixteen  cells  which  are  separated  from  it  by  one 
cell.  Ricbbourg  [Ref.  20]  showed  how  sixteen-neighbor  adjacency  could  decrease  the  inaccuracy  to  ap¬ 
proximately  1.9%. 

Not  only  does  digitization  bias  lead  to  inaccuracy,  it  also  means  that  multiple  solution  paths  could  be 
reported  depending  on  implementation  details  of  the  algorithm.  Path  representations  approximate  the  true  op¬ 
timal  path  in  the  actual  terrain  by  connected  line  segments  which  lie  in  allowed  directions.  So  a  true  optimal 
path  which  for  example  lies  at  a  22.5°  angle  with  the  horizontal  could  be  represented  by  one  which  starts  in  a 
45°  direction,  and  then  finishes  in  a  horizontal  direction,  or  it  could  be  represented  by  one  which  alternates 
many  times  betweeu  small  45°  line  segments  and  horizontal  line  segments,  somewhat  like  computer  graphics 
routines  represent  lines  with  sets  of  pixels.  The  latter  representation  is  to  be  preferred  because  it  more  close¬ 
ly  approximates  the  tnie  optimal  path,  and  some  researchers  have  proposed  ways  to  augment  wavefront 
propagation  algorithms  to  favor  paths  which  have  more  regular  turns,  so  as  to  better  approximate  line  seg¬ 
ments.  [Ref.  19],  [Ref.  20],  [Ref.  23],  [Ref.  24],  [Ref.  25] 

Mitchell  and  Kiersey  [Ref.  19]  discuss  an  implementation  of  wavefront  propagation  called  BITPATH 
which  partially  compensates  for  digitization  bias  by  modifying  the  w  ay  in  which  path  distances  are  computed. 
Vossepoel  and  Smoulders  [Ref.  26]  developed  an  estimate  for  the  actual  distance  over  a  true  optimal  path  given 
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a  digitized  approximation  which  lowers  the  estimate  each  time  the  approximation  path  turns,  based  on  the  idea 
that  each  turn  point  suggests  overestimation  of  Euclidean  distance.  BITPATH  incorporates  this  estimate  as 
the  cost  function  of  A*,  i.e.,  the  value  assigned  to  a  cell  to  represent  the  cost  of  the  best  path  from  the  start  cell. 
They  claim  a  significant  improvement  in  BITPATH’s  ability  to  find  a  solution  which  not  only  has  minimum 
cost  of  all  possible  paths,  but  also  lies  close  to  the  true  optimal  path.  [Ref.  19] 

In  an  attempt  to  reduce  the  dependency  of  accuracy  on  resolution,  data  representation  schemes  that 
use  multiple  resolutions  have  been  introduced  which  use  hierarchical  algorithms  which  are  generalizations  of 
wavefront  propagation  [Ref.  27].  One  such  scheme  uses  quad-trees  to  represent  larger  homogeneous  areas 
with  single  cells  [Ref.  28].  With  this  approach,  rectangles  are  inscribed  within  homogeneous-cost  regions  of 
the  input  map,  and  then  successively  smaller  rectangles  fill  out  the  shape  of  the  regions.  This  representation 
is  then  searched  much  the  same  as  in  wavefront  propagation. 

A  parallel  processing  approach  to  wavefront-propagation  path  planning  has  been  implemented  in  sup¬ 
port  of  the  DARPA-sponsored  autonomous  land  vehicle  built  by  Martin  Marietta  [Ref.  29].  Multiple  proces¬ 
sors  are  utilized  to  sweep  horizontal  bands  of  the  map,  at  each  cell  replacing  the  current  cost  of  its  neighbors 
if  the  current  cost  of  the  cell  plus  the  cost  to  move  to  the  neighbor  is  less  than  die  neighbor’s  current  cost  Mul¬ 
tiple  sweeps  are  employed  until  the  cost  values  stabilize.  Ricbbourg  [Ref.  20]  suggests  an  alternative  based  on 
mesh-connected  architectures  in  which  computational  elements  in  the  architecture  would  model  cells  in  the 
map,  yielding  an  O(n)  algorithm,  and  Jorgenson  [Ref.  30]  presents  a  wavefront  propagation  implementation 
on  a  neural-network  machine. 

2.  Spatial  Reasoning  Methods 

Spatial  reasoning  uses  principles  about  how  optimal  paths  must  behave  in  fire  presence  of  terrain  fea¬ 
tures  to  constrain  the  search  space  for  optimal  paths.  A  simple  example  of  this  type  of  reasoning  is  that  op¬ 
timal  paths  are  always  straight  lines  across  homogeneous  terrain,  and  in  the  case  of  binary  terrain  (obstacles 
on  a  homogeneous-cost  background),  turn  only  at  obstacle  vertices  (see  Theorem  1-2,  Appendix  A).  A  more 
general  type  of  discretization  than  that  used  by  wavefront  propagation  takes  place  when  terrain  features  are 
modelled  using  polygoos.  Here,  error  in  model  optimal  paths  versus  real-world  optimal  paths  can  be  much 
less  than  with  rectangular  tessclations,  but  since  algorithms  which  use  this  type  of  discretization  have  com- 
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plexities  which  depend  on  the  number  of  terrain-feature  vertices  in  the  map,  there  is  a  trade-off  between  ac¬ 
curacy  of  representation  and  speed  of  execution. 

Path-planning  methods  have  used  at  least  four  distinct  techniques  which  can  be  considered  spatial  reason¬ 
ing  techniques,  with  many  algorithms  appealing  to  more  than  one  of  the  techniques.  They  are  visibility-graph 
methods,  the  Snell’s  Law  local  optimization  criterion,  the  continuous-Dijkstra  paradigm,  and  methods  using 
optimal-path  maps. 

a.  Visibility  Graphs 

Visibility-Graphmelhods  [Ref.  1]  solve  the  polygonal  obstacle-avoidance  shortest-path  problem 
(binary  terrain),  constructing  a  graph  where  each  of  the  n  obstacle  vertices  plus  the  start  and  goal  points  are 
nodes,  and  undirected  arcs  connect  nodes  whose  vertices  are  intervisible,  i.e.,  can  be  connected  by  a  line  seg¬ 
ment  which  does  not  intersect  any  obstacle  edge.  Because  of  the  spatial  reasoning  principle  about  binary  ter¬ 
rain  stated  above,  it  is  assured  that  every  segment  of  an  optimal  path  will  occur  in  the  visibility  graph,  so  to 
And  an  optimal  path  it  is  sufficient  to  search  the  graph  using  branch- and-  bound  search. 

Several  algorithms  have  been  given  to  construct  Uie  visibility  graph.  The  naive  algorithm  checks 
every  pair  of  vertices  against  every  edge  to  see  if  the  line  segment  connecting  them  intersects  the  edge.  Since 
there  are  O(n')  pairs  of  vertices  and  O(n)  edges,  this  bruts  force  algorithm  has  worst-case  time  complexity 
0(n3).  Lee  [Ref.  31]  and  Mitchell  [Ref.  32]  explain  an  Q(n2  log  n)  algorithm  which  begins  by  constructing  for 
each  vertex  a  list  of  the  other  vertices  sorted  according  to  the  heading  of  the  line  between  them  in  0(n2log  n) 
time,  and  then  for  each  of  die  n  sorted  sets,  doing  an  angular  sweep  checking  for  intersection  against  the  closest 
obstacle  edge.  Welzl  [Ref.  33]  sisd  Asano  [Ref.  34]  used  the  fact  that  n  sorts  can  be  done  in  0(n2)  time  to  build 
an  0(n  )  visibility  graph  construction  algorithm.  Ghosh  and  Mount  [Ref.  35]  give  an  algorithm  to  compute 
the  visibility  graph  of  3  disjoint  line  segments  in  lime  0(e  +  n  log  n),  where  e  is  the  number  of  edges  in  the 
visibility  graph  (an  output-sensitive  complexity).  Since  e  may  be  as  small  as  n  or  as  large  as  n2,  this  algorithm’s 
worst-case  time  complexity  ranges  from  Gin  log  n)  to  0(n2)  depending  on  die  size  of  the  visibility  graph. 

Once  the  visibility  graph  has  been  constructed,  Dijkstra’s  algorithm  or  the  special  case  of  it  called 
A*  (see  Section  A),  may  be  used  to  search  for  the  shortest  path  from  the  start  to  the  goal.  The  worst-case  lime 
complexity  of  Dijkstra’s  algorithm  is  given  by  Aho,  Hopcroft,  and  Ullman  as  0(e  log  n)  [Ref.  36],  Again,  be¬ 
cause  of  the  range  of  c,  litis  means  that  Dijkstra's  algoritltm  is,  in  (lie  worst  case,  0(n2  log  n),  or  widt  a  sparse 
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visibility  graph,  0(n  log  n).  A*,  an  "informed"  version  of  Dijkstra’s  algorithm,  has  time  complexity  of  the 

same  order  class  in  the  worst  case  [Ref.  15],  although  actual  implementations  should  show  a  significant  em- 

2 

phi  cal  superiority  of  A*.  Thus,  the  shortes  t-path  problem  can  be  solved  by  a  visibility-graph  approach  in  0(n 
log  n)  time. 

For  the  variation  of  the  weighted-region  problem  (r'r  generalization  of  the  sbortest-path  problem) 
given  by  Rowe  [Ref.  2]  which  considers  roads  and  rivets  as  well  as  obstacles,  a  visibility-graph-influenced 
approach  is  used  to  transform  the  search  space  to  a  finite  one.  Reasoning  about  bow  optimal  paths  must  be¬ 
have  in  die  presence  of  roads  and  rivers  leads  to  the  conclusions  that  a  path  will  enter  or  leave  a  road  at  only 
one  critical  angle,  and  that  paths  either  cross  a  river  without  changing  beading,  or  go  arouod  river-end  vertices 
as  they  would  an  obstacle  vertex.  A  visibility  graph  is  constructed  using  as  nodes  all  obstacle  and  river  ver¬ 
tices  and  start  and  goal  points;  roads  and  rivers  are  not  considered  to  obscure  visibility.  Additionally,  line  seg¬ 
ments  horn  each  node  are  constructed  which  intersect  each  road  at  the  critical  angle.  If  the  points  are  otherwise 
visible,  die  road-intersection  point  is  added  as  a  node  and  the  graph  reflects  that  the  points  are  connected.  Fur¬ 
ther,  all  nodes  which  lie  on  contiguous  road  segments  are  connected.  This  graph  is  then  searched  using 
Dijkslra’s  or  A*  algorithms  as  above.  Figure  8  shows  the  edges  of  an  example  generalized  visibility  graph.  In 
this  figure,  solid  lines  represent  roads,  dotted  lines  represent  rivers,  and  filled  polygons  represent  obstacles. 
Narrow  dashed  lines  represent  V-grap  edges  and  She  thick  dashed  line  represents  the  optimal  path  from  start 
to  goal  points.  Similar  results  for  linear  features  are  reported  by  Gewali  et  al.  [Ref.  37] 
b.  Snell’s  Law  Local  0  primarily  Criterion 

Optimal  paths  in  the  weighted-region  domain  obey  an  analogy  to  Snell's  Law  of  Refraction  in 

optics  [Ref.  20],  [Ref.  3],  [Ref  38].  Snell’s  Law  is  based  on  Fermat's  Principle  which  says  that  light  seeks  the 

path  of  minimum  time.  Fermat’s  Principle  has  an  analogy  in  the  weighted-region  problem,  since  time  is  a  cost 

proportional  to  distance  travelled  in  a  homogeneous-index  region.  Thus  optimal  paths  follow  Snell’s  Law, 

Snell’s  Law  for  Optimal  Paths:  An  optimal  path  passing  tlirough  an  edge  between  two  regions 
will*  costs-per-unit-distance  ci  and  cz  obeys  the  relationship  ci  sin  0i  =  C2  sin  02,  where  0|  and  02 
are  tire  angles  of  incidence  and  refraction  respectively,  i.e.,  the  angle  from  the  path  in  the  first  region 
to  a  line  normal  to  the  edge,  and  the  angle  from  the  path  in  the  second  region  to  a  line  normal  to  the 
edge.  (See  Figure  9.) 
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Figure  8 

Visibility  Graph  for  RRR  Algorithm 


Note  that  Snell’s  Law  is  a  criterion  for  local,  not  global,  optimality;  a  non-optimal  path  may  obey  Snell’s  Law 
at  each  edge  crossing.  Therefore,  its  usefulness  is  in  constructing  candidates  for  global  optimality. 

The  analogy  to  Snell’s  Law  applies  to  crossings  with  an  angle  of  incidence  and  refraction  such 
that  0i  and  02  are  both  less  than  or  equal  to  90°.  In  the  path-planning  domain  optimal  paths  cannot  occur 
that  have  angles  of  incidence  greater  than  a  critical  angle  which  is  0C  =  sin'1  ci/cj,  where  c;  <  q  and  q  is  the 
cost  of  the  region  on  the  incidence  side  of  the  edge.  For  example,  in  figure  10  an  optimal  path  may  go  from 
point  S  to  any  point  to  the  left  of  point  A,  but  may  not  go  immediately  to  its  right,  because  the  angle  0 1  h  a  t 
line  AB  would  form  with  edge  PQ  of  the  high-cost  region  would  exceed  0C.  This  is  called  total  internal 
reflection,  in  optics.  Another  example  of  such  behavior  is  found  in  figure  11,  where  a  path  SABG  follows 
Snell’s  Law  making  an  angle  exactly  the  critical  angle  at  point  A  and  then  at  B. 

In  Figure  12,  paths  just  to  the  left  of  SV  will  be  refracted  according  to  Snell’s  Law  as  is  path 
SVA,  while  paths  just  to  the  right  of  SV  will  be  refracted  as  is  path  SVB,  but  paths  which  go  through  point  V 
may  lie  anywhere  within  the  wedge  formed  by  A  VB.  If  we  consider  that  the  edges  which  meet  at  point  V  are 
actually  continuously  curved  there,  Snell’s  Law  will  apply  as  the  local  curvature  increases  to  infinity.  The 
same  behavior  happens  in  figure  13,  at  vertex  V  of  an  obstacle. 

finding  an  exact  Snell’s-Law  path  between  two  points  through  a  sequence  of  edges  requires  an 
iterative  search.  Richbourg  [Ref.  20]  and  Mitchell  [Ref.  15]  both  discuss  the  lack  of  a  closed-fonn  solution  for 
the  problem  of  finding  the  Snell’s-Law  path  between  two  points.  But  since  it  is  an  easy  task  to  trace  a  Snell ’s- 
Law  path  from  a  point  with  a  given  heading,  both  conclude  that  an  iterative  search  is  the  best  approach.  Rich¬ 
bourg  studies  the  effectiveness  of  four  techniques  for  finding,  to  within  a  given  error,  a  Snell’s-Law  path  across 
one  edge.  He  used  experiments  applied  to  bisection  search,  golden-section  search,  false-position  search,  and 
a  modification  called  heuristic  false-position  search,  and  found  that  the  latter  converged  more  than  twice  as 
fast  as  any  of  the  others  on  the  average,  and  also  had  the  least  standard  deviation  of  the  four  methods.  His 
heuristic  false-position  method  attempts  to  avoid  the  situation  wiiere  the  search  approaches  the  solution  from 
the  same  side  at  each  iteration,  since  false-position  tends  to  converge  more  quickly  when  the  solution  is  brack¬ 
eted. 

Mitchell’s  algorillun  uses  a  numerical  routine  to  approximate  the  Snell  ’s-Law  path  across  n  edges 
which  is  of  a  time  complexity  that  he  calculates  is  bounded  by  O(nL),  where  L  is  a  measure  of  the  precision 
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Figure  10 

Snell’s  Law  Example  1 


Figure  11 

Snell’s  Law  Example  2 
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Figure  12 

Snell’s  Law  Example  3 

42 


Figure  13 

Snell’s  Law  Example 4 


43 


of  the  problem  instance.  This  routine  is  used  because  of  its  proven  worst-case  speed,  but  be  also  reports  a  coor¬ 
dinate  descent  method  for  solving  a  Snell’s-Law  path  across  several  edges  which  is  said  to  have  fast  empiri¬ 
cal  convergence.  This  method  uses  as  a  starting  path  a  sequence  of  line  segments  between  start  and  goal  points 
through  the  midpoint  of  each  edge.  It  then  successively  adjusts  each  crossing  point  in  constant  time  to  satisfy 
Snell’s  Law  with  respect  to  its  two  neighbor  crossing  points,  iteratively  applying  these  adjustments  until  the 
path  is  within  a  specified  error  of  the  goal. 

c.  Continuous-Dijkstra  Paradigm 

Path-planning  methods  for  the  weighted-region  problem  have  used  one  of  two  similar  ap¬ 
proaches,  both  relying  on  Snell’s  Law  and  related  properties  as  discussed  above.  Mitchell’s  algorithm  uses 
what  he  calls  the  continuous-Dijkstra  paradigm,  because  of  its  analogy  to  the  discrete  Dijkslra  algorithm  [Ref. 
3],  while  Richbourg’s  algorithm  uses  recursive  wedge  decomposition  [Ref.  20],  [Ref.  21].  Whereas  Dijkstra’s 
algorithm  must  be  used  over  terrain  approximated  by  map  discretization,  the  continuous-Dijkstra  and  the  recur¬ 
sive-wedge-decomposition  paradigms  are  used  over  terrain  in  which  terrain  features  are  represented  by 
polygons  or  piecewise-linear  curves. 

The  continuous-Dijkstra  paradigm,  analogously  to  searching  a  finite  graph  for  the  next  closest 
node  in  Dijkstra’s  algorithm,  searches  in  a  concentric  plane  sweep  outward  from  the  start  point,  processing 
each  terrain-feature  vertex  as  the  sweep  reaches  it.  The  algorithm  requires  the  triangulation  of  the  terrain  map, 
a  task  for  which  standard  algorithms  are  available  from  computational  geometry.  Each  vertex  has  associated 
with  it  a  label  which  represents  the  cost  of  the  best  path  yet  found  to  it,  just  as  in  the  discrete  Dijkstra  algo¬ 
rithm.  Additional  points,  called  frontier  points,  also  have  labels  associated  with  them.  They  are  points  in  the 
interior  of  an  edge  at  which  critical  reflection  occurs  (see  above). 

The  key  data  structures  for  Mitchell ’s  algorithm  are  first,  a  list  of  subsegments  of  terrain-feature 
edges  called  candidate  intervals  of  optimality,  and  second,  a  priority  queue  called  the  event  queue  after  the 
terminology  used  in  the  plane  sweep  paradigm.  Candidate  intervals  of  optimality  are  the  extent  of  an  edge  over 
wliich  an  optimal  path  could  possibly  lie  by  tlie  constraints  of  Snell’s  Law.  Intervals  include  information  about 
tire  root,  or  last  previous  vertex  through  wliich  tlie  all  optimal  paths  which  cross  the  interval  lie,  and  about  the 
paths  from  tliis  root  to  either  end  of  the  subsegment  interval.  The  event  queue  contains  those  points  which  are 
end  points  of  some  candidate  interval,  or  are  frontier  points  in  the  interior  of  an  interval. 
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At  each  step  of  the  algorithm,  the  point  on  the  event  queue  with  the  smallest  cumulative  cost 
from  the  start  point  is  chosen.  If  it  is  a  frontier  point,  then  the  candidate  interval  is  said  to  propagate ,  In  other 
words,  more  candidate  intervals  on  other  edges  are  found  each  of  which  includes  an  edge  subsegment  to  which 
optimal  paths  could  arrive  through  the  initial  interval.  The  appropriate  points  have  tlieir  costs  computed  and 
are  added  to  the  event  queue.  When  the  event  queue  becomes  empty,  the  algorithm  terminates,  and  the  goal 
point  has  been  labelled  with  its  optimal  cost.  The  list  of  candidate  intervals  holds,  at  any  point  in  the  algorithm, 
the  best  path  or  set  of  paths  so  far  from  the  start  point  to  the  interval,  so  the  interval  which  is  the  goal  point  is 
found  in  order  to  retrieve  tl>e  optimal  path.  This  algorithm  has  at  most  0(n3)  event  points,  and  uses  the  0(n*L) 
routine  discussed  above  to  find  a  Snell 's-Law  path  between  two  points,  and  so  has  a  worst-case  time  com¬ 
plexity  of  0(n7L),  where  n  is  the  number  of  terrain-feature  vertices  and  L  is  a  measure  of  the  precision  of  the 
problem  instance. 

Richbourg’s  algorithm  uses  A*  search  to  select  a  group  of  paths  for  refinement  which  offers  the 
best  hope  of  containing  the  optimal  path  from  the  start  point  to  the  goal  [Ref.  20].  As  refined  Rowe  and  Rich- 
bourg  [Ref.  39],  a  well-behaved  path  subspace  (WBPS)  is  defined  as  a  set  of  paths  which  cross  the  same  ter¬ 
rain-  feature  edges  and  vertices  from  the  start  to  the  goal.  A  wedge  is  a  partial  WBPS  which  is  a  set  of  paths 
crossing  the  same  edges  and  vertices  from  the  start  point  to  some  intermediate  point  or  edge.  Refining  a  wedge 
means  finding  within  the  wedge  the  nearest  intermediate  point  which  has  not  yet  been  considered,  Coding  a 
Snell ’s-Law  path  to  that  point,  and  splitting  the  wedge  into  three  sub-wedges  based  on  the  cases  which  arise 
from  Snell’s  Law.  These  three  wedges  arc  added  back  to  the  A*  agenda  for  further  consideration.  Two  of  the 
three  wedges  are  those  consisting  of  paths  which  pass  to  the  "left"  and  "right"  of  the  point  at  which  splitting 
occurs,  wliilc  the  middle  wedge  is  constructed  based  on  the  possible  behavior  of  paths  emanating  from  the 
point.  The  tenn  recursive  wedge  decomposition  refers  to  the  successive  splitting  of  wedges  as  they  are  selected 
from  the  A*  agenda  and  refined. 

The  search  space  for  recursive  wedge  decomposition  is  a  known  feasible  start-to-goal  path  and 
a  set  of  wedges  with  associated  lower-bound  values  of  cost  function  plus  evaluation  function  for  each  wedge. 
These  lower-bound  values  represent  the  lowest  possible  cost  for  a  path  within  the  wedge.  The  known  feasible 
path  is  replaced  whenever  a  better  path  is  found,  so  Ural  it  is  always  the  best  known  path.  The  single  operator 
for  slate  transformation  is  wedge  refinement.  The  algorithm  uses  a  different  termination  criterion  than  that 
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normally  used  by  A*  in  path-planning  applications.  Normally  the  search  can  stop  when  the  first  clement  on 
the  agenda  is  a  complete  solution,  because  the  agenda  is  ordered  by  increasing  cost-function  plus  evaluation- 
function  values,  and  for  a  complete  path  the  evaluation  function  equals  zero  and  the  cost  function  is  the  ac¬ 
tual  cost  from  start  to  goal.  However,  in  this  search  space,  the  elements  on  the  agenda  are  wedges,  wot  paths. 
The  search  terminates  when  the  best  wedge  on  the  agenda  (and  hence  all  other  wedges  on  the  agenda  as  we.fi) 
has  a  cost-function  plus  evaluation-function  value  that  exceeds  the  upper-bound  cost  of  the  current  best  feasible 
known  path,  or  when  the  agenda  is  empty.  In  either  case  the  least-cost  known  path  is  the  solution.  Wedges  arc 
pruned,  or  removed  from  the  search  space,  according  to  a  set  of  criteria  based  on  Snell’s  Law  and  other  spa¬ 
tial  reasoning.  An  implementation  of  Ricbbourg’s  recursive- wedge-decomposition  algorithm  is  reported  to 
have  empirical  performance  which  strongly  suggests  an  0(n2)  average-case  time  complexity,  where  n  is  the 
number  of  terrain-feature  vertices.  Worst-case  time  complexity  was  reported  to  be  0(nin  )  [Ref.  39]. 

The  two  algorithms  are  quite  similar  in  some  respects.  The  candidate  interval  of  the  continuous- 
Dijkstra  algorithm  along  with  its  associated  data  about  boundary  paths  corresponds  to  the  wedges  of  the  recur¬ 
sive-wedge-decomposition  algorithm,  and  propagation  of  intervals  corresponds  to  refinement  of  wedges.  The 
same  properties  of  Snell’s  Law  refraction  and  critical  reflection  are  used  in  determining  how  to  refine  wedges 
(propagate  intervals).  However,  there  arc  differences  of  emphasis.  The  focus  of  the  continuous-Dijkstra  algo¬ 
rithm  seems  to  be  finding  apolynomial-timc  worst-case  algorithm,  while  the  A*  search  of  the  recursive-wedge - 
decomposition  algorithm  focuses  on  average-case  performance.  The  continuous-Dijkstra  algorithm  requires 
a  triangulation  of  the  input  map,  a  time-consuming  preprocessing  step  which  nevertheless  does  not  raise  the 
worst-case  time  order  of  complexity,  while  the  recursi  ve-wcdge-decomposilion  algorithm  takes  as  input  a  map 
of  polygonal  terrain  features.  The  recmsive-wedge-decomposition  implementation  reported  in  [Ref.  21]  was 
used  in  our  research  for  initialization  in  our  Chapter  VI  algorithms. 

A  generalization  of  lire  weighted-region  problem  allows  anisotropic  costs  in  regions,  that  is,  costs 
which  are  a  function  of  (Ik-  direction  of  travel  of  the  mobile  agent,  for  example,  in  steeply  sloped  terrain.  Ross 
(Ref  40]  solves  the  anisotropic  weighted-region  problem  using  a  variation  of  recursive-wedge  decomposition. 
Based  on  the  effects  of  gravity,  friction,  and  maximum  force  which  can  be  applied  by  the  agent,  there  arc 
several  sets  of  impermissible  headings  which  may  constrain  travel  across  a  polygonal  region.  A  range  of  uphill 
headings  may  be  ruled  cut  by  maximum  farce  available,  loss  of  traction,  or  catastrophic  overturn,  and  a  range 
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of  side  slope  headings  may  be  ruled  out  by  catastrophic  overturn  considerations.  Additional  optimality  con¬ 
siderations  include  a  range  of  downhill  braking  headings  within  which  the  agent  must  lose  energy  by  braking, 
and  Snell ’s  Law  for  optimal  paths  as  described  above.  Given  these  constraints,  there  are  only  four  ways  an  op¬ 
timal  path  can  cross  an  anisotropic  region.  This  insight  leads  to  an  algorithm  wlu'ch  recursively  decomposes 
groups  of  potentially  optimal  paths  according  to  which  terrain-feature  vertices  and  edges  they  cross  (window 
sequences),  and  applies  A *  search  to  these  groups  of  paths,  using  various  pruning  criteria  to  limit  the  search 
space. 

d,  Optimal-Path  Maps 

Several  researchers  have  used  optimal-path  maps  (OFM),  or  as  they  are  commonly  called  with 
respect  to  binary  terrain,  shortest-path  maps ,  as  a  means  of  solving  the  sbortest-path,  binary-terrain  problem. 
Lee  and  Preparata  [Ref.  41]  give  an  Ofn  log  n)  algorithm  to  construct  an  OPM  for  the  special  case  that  all 
obstacles  are  parallel  line  segments,  and  Reif  and  Storcr  [Ref.  42]  give  an  0(mn  +  n  log  n)  algorithm,  where 
m  is  the  number  of  obstacles  and  n  is  the  number  of  obstacle  vertices.  Mitchell  [Ref.  4]  gives  an  0(kn  log7  a) 
algorithm  for  the  general  case,  where  k  is  an  output-sensitive  parameter  somewhat  related  to  the  density  of 
obstacles  in  the  plane. 

Tlie  algnritlun  of  Lee  and  Preparata  uses  the  plane  sweep  paradigm  and  cotstiucls  both  the  op¬ 
timal-path  tree  and  the  planar  partition  with  coe  sweep  of  the  plane.  Assuming  without  loss  of  generality  that, 
the  parallel  line-segment  obstacles  are  vertical  and  the  start  point  is  to  the  left  of  all  obstacles,  the  sweep  line 
is  also  vertical  and  begins  at  the  start  point.  The  obstacles  are  indexed  by  tbea  x-coctdinfttes,  and  the  initial 
event  queue  contains  the  x-coordinates  of  each  obstacle.  As  the  sweep  line  encounters  an  obstacle,  It  locales 
the  two  endpoints  in  regions  of  the  OFM  so  far  constructed  and  extends  the  ectimal-path  tree  by  inserting  a 
node  for  each  obstacle  endpoint  into  the  tree  at  the  node. associated  with  these  regions.  Then  it  constructs  the 
three  bisectors,  or  homogeneous-behavior  region  boundaries,  which  begin  s?  the  obstacle,  two  of  which  are 
rays  and  one  of  which  is  a  hyperbola  segment.  It  updates  a  list  of  "active"  bisectots  by  deleting  previously- 
found  bisectors  which  intersect  the  current  obstacle,  and  adds  the  new  hisectnj?.  lisp  Then  it  updates  !be 
event  queue  by  Inserting  points  of  intersection  of  die  new  bisectors  with  tatty  other  bisectors.  Only  the  left¬ 
most  such  intersection  must  be  recorded.  At  each  stage,  the  OFM  is  updated  wluso  both  endpoints  of  a  bisec¬ 
tor  arc  found.  {Ref.  41] 
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Hie  algorithm  due  to  Reif  and  Stoier  takes  as  input  a  triangulation  of  the  obstacle  edges,  and 
recursively  processes  these  triangles  to  rind  shortest  paths  from  the  .start  point  to  each  vertex  of  the  triangula¬ 
tion.  The  algorithm  “grows"  outward  from  the  start  point,  constructing  a  partition  of  the  plane.  The  discussion 
of  this  algorithm  in  Reference  42  is  somewhat  obscure,  as  it  does  not  use  the  terminology  of  shortest-path 
maps,  and  depends  on  other  algorithms  and  data  structures  not  fully  explained  in  Reference  42. 

A  solution  to  the  optimal-patb-map  problem  which  takes  a  different  approach  is  presented  by 
Payton  [Ref.  43].  It  is  built  on  the  wavefront  propagation  algorithm,  and  consists  of  storing  the  back-pointers 
for  each  cell.  This  array  of  pointers  is  called  a  gradient  field,  and  provides  information  about  which  direction 
a  mobile  agent  should  go  from  any  point  on  the  map  in  order  to  travel  along  an  optimal  path.  This  approach 
could  he  used  with  oilier  point-to-point  path  planners  as  well,  although  with  greatly  increased  preprocessing 
time,  by  simply  running  the  path  planner  for  a  finely-grained  array  of  start  points,  and  storing  the  initial  direc¬ 
tion  of  the  resulting  optimal  path  for  each  run. 

Mitchell’s  algorithm  introduces  the  concept  of  "generalized  visibility"  within  the  obstacle  space, 
and  constructs  shortest-path  maps  for  each  new  level  of  visibility.  This  algorithm  begins  by  computing  the 
visibility  polygon  from  the  start  point,  i.c.,  the  polygon  containing  all  points  in  the  map  which  are  not  occluded 
from  the  start  point  by  an  obstacle  edge.  Then  it  appeals  to  the  algorithm  for  constructing  generalized  Voronoi 
diagrams  within  simple  polygons  due  to  Aronov  [Ref.  13]  which  takes  into  account  that  boundaries  may  be 
hyperbolic  or  linear,  depending  on  the  costs  of  optimal  paths  from  obstacle  vertices.  Using  this  generalized- 
Voronoi-diagram  concept,  Mitchell’s  ajiproach  constructs  a  shortest-path  map  for  the  visibility  polygon.  Then, 
tlic  algorithm  computes  the  sectmd  level  of  visibility,  that  is,  extends  the  visibility  polygon  to  include  all  points 
visible  from  any  part  of  the  inifia!  visibility  polygon.  Again,  it  reduces  the  problem  of  extending  the  shortest- 
path  map  to  the  problem  of  defining  appropriate  Yoronoi-diagram  problems  on  simple  polygons.  This  process 
continues  iteratively  until  all  obstacles  have  been  found  by  the  generalized  visibility  process.  [Ref.  4] 

So  essentially,  Mitchell’s  algorithm  is  doing  a  concentric  plane  sweep  (although  not  using  this 
terminology),  where  at  each  iteration,  the  next  generalized  visibility  polygon  is  found,  a  Voronoi  diagram  is 
constructed  for  the  obstacles  in  tbe  polygon,  and  these  Voronoi  diagrams  are  merged  with  the  Voronoi  diagram 
from  the  previous  iterations.  The  computation  of  visibility  polygons  does  use  tbe  plssss  sweep  paradigm  ex¬ 
plicitly,  sweeping  a  "geodesic"  (or  optimal)  path  angularly  about  lire  start  pom*.  In  order  lo  deal  with  several 
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cases  in  which  a  single  sweep  would  not  correctly  identify  all  the  event  points,  two  sweeps,  one  in  each  direc- 
tion  about  the  start  point,  are  done  to  compute  each  visibility  polygon.  This  algorithm  operates  in  0(n  log  n) 
worst-case  time,  where  n  is  the  number  of  obstacle  vertices  in  the  input  map.  [Ref.  4] 

The  locus  of  this  dissertation  is  on  the  construction  of  a  planar  partition  for  the  weighted-region 
problem.  In  keeping  with  the  convention  discussed  above  of  referring  to  solutions  to  the  weighted-region 
problem  as  optimal  paths  instead  of  shortest  paths,  we  refer  to  such  a  partition  as  an  optimal-path  map.  Mitchell 
[Ref.  15],  claims  to  have  constructed  an  optimal-path  map  for  the  weighted-region  problem,  but  does  not  men¬ 
tion  die  task  of  constructing  region  boundaries.  His  algorithm  appears  to  construct,  instead,  an  optimal-path 
tree,  a  necessary  and  time-consuming  first  step  in  constructing  an  optimal-path  map,  but  gives  little  attention 
to  construction  of  the  planar  partition.  This  confusion  may  arise  from  the  fact  that  in  the  binary-terrain  domain, 
construction  of  region  boundaries  is  straightforward,  a  fairly  insignificant  part  of  the  total  problem,  while  the 
added  complexity  of  the  weighted-region  problem  creates  additional  complexities  in  the  characterization  of 
boundaries  and  the  construction  of  the  optimal-path  map.  In  binary  terrain,  the  standard  Voronoi-diagram 
methods  which  construct  straight-line  bisectors  only  need  to  be  extended  to  construct  hyperbola  segments  as 
well,  while  in  weighted-region  terrain,  such  bisectors  take  onmany  different  forms.  Thus  the  problem  of  "defin¬ 
ing  die  appropriate  Voronoi-diagram  problem",  as  Mitchell  does  in  the  binary  case,  is  a  much  more  difficult 
one. 
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HI.  MODIFYING  WAVEFRONT  PROPAGATION  TO  FIND  SUB-OPTIMAL 
SOLUTIONS  TO  THE  OPTIMAL-PATH-MAP  PROBLEM 


A.  OVERVIEW 

Wavefront  propagation  is  well-suited  as  a  method  for  solving  the  fixed-goal  optimal-path-map  problem 
(see  Chapter  II,  Section  C  for  a  complete  description  of  this  problem),  if  the  inherent  error  is  acceptable  in  the 
application  domain.  The  basic  wavefront  propagation  algorithm  can  easily  be  extended  by  considering,  for 
each  cell  on  the  wavefront,  whether  there  should  be  a  boundary  between  it  and  its  adjacent  cells,  using  one  of 
the  three  definitions  of  "similar  behavior".  What  for  the  point-to-point  problem  was  a  disadvantage  of 
wavefront  propagation,  that  the  algorithm  in  its  basic  form  searched  blindly  in  all  directions  without  regard  to 
the  location  of  the  goal,  becomes  an  advantage  for  the  optimal-path-map  problem  because  the  paths  from  each 
cell  in  the  map  are  available  as  a  by-product  of  the  algorithm  simply  by  tracing  the  back  pointers.  Another  ad¬ 
vantage  is  that  the  asymptotic  worst-case  time  complexity  of  the  extension  is  the  same  as  the  basic  algorithm. 

In  chapter  II  the  path-generalizing  function  was  defined  in  terms  of  "similar  behavior”  of  paths.  In  this 
chapter  we  solidify  the  meaning  of  "similar  behavior"  to  group  paths  in  three  different  ways  that  make  sense 
for  wavefront  propagation,  thus  defining  the  path-generalizing  function  in  three  ways.  The  first  way  produces 
boundaries  between  adjacent  cells  whose  goal  paths  turn  at  cells  which  are  not  "equivalent".  The  second  way 
uses  a  set  of  heuristics  to  group  cells  whose  goal  paths  converge.  The  third  way  groups  cells  according  to 
whether  their  paths  turn  at  the  same  terrain-feature  vertices  and  edges. 

It  might  be  possible  to  bypass  the  need  for  an  opiimal-patli  map  altogether  by  simply  storing  back  pointers 
for  every  cell  in  the  map  (for  example,  in  the  work  of  Payton  discussed  in  Chapter  II  [Ref.  43],  such  a  database 
of  pointers  is  called  a  gradient  field).  Given  a  start  cell ’s  coordinates,  the  path  to  the  goal  could  be  reconstructed 
by  following  the  pointers  back  to  the  goal  cell.  There  are  two  disadvantages  to  this  method.  First,  the  average- 
case  time  complexity  to  reconstruct  a  backpatb  is  O(n),  for  an  input  map  of  size  n  by  n.  Second,  the  storage 
requirement  for  the  optimal-path  map  is  0(n2 ).  To  avoid  these  problems,  we  store  an  optimal-path  map. 
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B.  MODIFYING  THE  PATH-GENERALIZING  FUNCTION  FOR  WAVEFRONT 
PROPAGATION  OPTIMAL-PATH-MAP  CONSTRUCTION 

1.  The  Pure  Version  of  Wavefront-Propagation  Optimal-Path-Map  Construction 

The  most  natural  description  of  a  path  is  the  list  of  all  cells  from  start  point  to  goal  point.  Requiring 
two  such  path  lists  to  be  identical  in  order  to  represent  "similar  behavior"  would  result  in  every  cell  in  the  map 
comprising  its  own  homogeneous-behavior  region.  But  it  is  unnecessary  to  include  all  cells  in  a  path  segment 
which  lie  in  on  the  same  straight  line.  So  another  definition  of  a  path  list  is  the  list  of  cells  at  which  the  op¬ 
timal  path  turns,  or  more  precisely,  the  cells  in  the  backpath  of  a  start  point  for  which  each  back-pointer  of  the 
cell  is  in  a  different  direction  than  tlte  back-pointer  of  the  cell’s  parent. 

This  definition  still  induces  many  distinct  regions.  A  modification  is  to  specify  that  two  lum-point 
cells  on  different  backpaths  are  considered  equivalent  if  one  of  them  lies  on  the  first  leg  of  the  optimal-path 
list  which  starts  at  the  other  turn-point.  Thus,  for  example,  the  two  cells  (5,3)  and  (6,2)  in  Figure  7  would  have 
optimal-path  lists  [(5, 5), (7 ,7)]  and  [(6, 6), (7 ,7)]  respectively;  cells  (5,5)  and  (6,6)  would  be  considered 
equivalent  because  the  optimal-path  list  of  cell  (5,5)  is  [(7,7)]  and  (6,6)  lies  on  the  line  between  (5,5)  and  (7,7); 
so  cells  (5,3)  and  (6,2)  lie  in  the  same  region. 

We  call  the  version  of  the  wavefront  propagation  optimal-path-map  algorithm  which  uses  this  defini¬ 
tion  of  the  path-generalizing  function  tlte  pure  version,  since  it  is  based  on  a  simple  definition  of  homogeneous- 
behavior  regions.  Changes  to  tlx:  basic  wavefront  propagation  algorithm  in  Appendix  B  necessary  to  implement 
tliis  are  presented  in  Table  1  below  (two  pages).  The  key  change  is  a  check  for  boundaries  between  each  cell 
on  tlte  wavefront  and  its  four  neighbors.  This  is  accomplished  in  procedure  expand-cell  which  is  executed 
once  for  each  cell  on  the  current  wavefront.  Procedure  expand-celi  calls  procedure  check-for-boundaries 
which  compares  the  path  lists  of  each  of  die  cell's  neighbors  with  the  expanding  cell's  path  list,  checking  for 
"equivalency"  as  defined  above.  Whenever  a  new  cell  is  added  to  the  wavefront,  its  path  list  is  set  by  proce¬ 
dure  set -optimal-path-list  which  is  called  from  witliin  orthoguns! -expand,  diagonal-expand,  and  overflow. 
These  procedures,  although  not  shown  lterc,  are  modified  from  the  versions  shown  in  Appendix  B  by  adding 
a  call  to  set-optimal-path-list  after  each  new  cell  is  added  to  die  wavefront  list  or  tlic  overflow  list.  When  die 
procedure  check-equivalent-paths  called  by  check-for-boundaries  dcteimincs  that  two  path  lists  arc  not 
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TABLE  1 


WAVEFRONT-PROPAGATION  OPM  ALGORITHM 


algorithm  wavefront-propagation-opm 
input:  Goal-Point 

l 

Wavefront  :=  Goal-Point: 
Boundary-List  :=  empty  list; 
while  (Wavefront  not  empty) 
expand-wavefront(Wavefront); 

) 


(Algorithm  UI-1) 

/*  REVISED  from  algorithm  B-l  */ 
/*  in  Appendix  B.  +/ 


/♦  Iteratively  expand  wavefront  */ 

/*  until  nothing  remains  on  it.  */ 

/+  end  of  wavefront-propagation-opm  */• 


/*  REVISED  PROCEDURE  */ 


/*  Base  case  of  the  recursion.  */ 

Cells-for-New- Wavefront  :=  empty  list; 

New- Wavefront  :=  empty  list; 

) 

else 


procedure  expand-wavefront 
input:  Wavefront 
I 

if  (Wavefront  is  empty) 


{ 

Current-Cell  :=  cell  on  Wavefront  with  min  remaining  cost; 
expand-ceU(Current-Cell); 

Rest-of- Wavefront  :=  Wavefront  less  Current-Cell; 
expand-wavefront(Rest-of-Wavefront); 

New-Wavcfronl  :=  Cells-for-New- Wavefront 
appended  onto  front  of  New-Wavefront; 

) 


I*  recursive  call  to  expand-wavefront  */ 

/*  Note:  Wavefront  is  recursively  emptied  *1 
/*  out  level  by  level  and  New-Wavefront  *1 
/*  is  built  up  as  each  level  returns.  */ 

/*  end  of  expand-wavefront  */ 


procedure  expand-cell 
input:  Current  Cell 

l 

Fmished-With-Ccll  :=TRUE; 
check-for-boundaries(Current-Cell); 

Boundary-List  :=  New-Boundary-List  appetKled 
to  Boundary-List; 

Cells-for-New- Wavefront  :=  empty  list; 
for  (New-Cell  :=  North-,  East-,  South-,  and  West-Neighbor) 
orthogonal-expand(Current-Cell, New-Cell): 
for  (New-Cell  :=  Northeast-,  Southeast-,  Southwest-,  and  Northwest-Neighbor) 
diagonaI-expand(Current-Cell, New-Cell); 

if  not  (Finished-With-Cel!)  I*  keep  Current-Cell  on  Wavefront  */ 

Cells-for-New- Wavefront  :=  Current-Cell  appended 
onto  Cells-for-New-Wavefront;  /*  CHECK  FOR  GOAL  DELETED  *1 


/*  REVISED  PROCEDURE  */ 

/*  initialize  flag  assuming  that  Current-Cell  */ 
I*  will  not  stay  on  Wavefront  */ 

/♦  ADDED  TO  THIS  VERSION  */ 

I*  ADDED  TO  THIS  VERSION  */ 


/*  end  of  expand-cell  */ 
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TABLE  1  (CONTINUED) 

WAVEFRONT-PROPAGATION  OPM  ALGORITHM 


procedure  check-for-boundaries  /*  NEW  PROCEDURE  */ 

input:  Current-Cell 

( 

New-Boundary-List  :=  empty  list; 
for  (Neighbor-Cell  :=  each  of 
Current-Cell’s  eight  neighbors) 

if  not  (Parent-Pointer  of  Neighbor-Cell  =  nil)  /*  if  wavefront  has  reached  neighbor,  */ 

{  /*  a  boundary  clreck  can  be  made.  */ 

0PL1  :=  OPL-Parent  of  Neighbor-Cell; 

0PL2  :=  OPL-Parent  of  Current-Cell; 

if  not  (clieck*equivalent-paths(0PLl,0PL2))  /*  update  new  boundary  list  */ 

New-Boundary-List  :=  edge  or  comer 

connecting  tlie  two  cells  appended  to  New-Boundary-List; 

) 

)  /*  end  of  cbeck-for-boundaries  */ 

procedure  set-optimal-path-list  /*  NEW  PROCEDURE  */ 

input:  Cell 

|  /*  NOTE:  There  are  two  parent-pointer  fields  in  */ 

if  (Parent  of  Cell  is  on  line  segment  between  /*  the  "Cell"  array  -  "Parent"  field  is  predecessor  +/ 

Cell  and  OPL-Parent  of  Parent  of  Cell)  /♦  of  Cell  on  the  backpatli:  "OPL-Parent"  is  the  */ 

OPL-Parent  of  Cell  :=  OPL-Parent  /*  predecessor  on  the  Optimal-Path  List.  */ 

of  Parent  of  Cell: 
else 

OPL-Parent  of  Cell  :=  Parent  of  Cell; 

)  /*  end  of  optimal-path-list  */ 

procedure  check-equ  i  valen  t-pa  t  hs  /*  NEW  PROCEDURE  */ 

input:  0PL1,  the  OPL-Parent  of  Neighbor-Cell 
and  0PL2,  the  OPL-Parent  of  Current-Cell 
output:  returns  TRUE  if  paths  are 
equivalent,  FALSE  otherwise. 

I 

if  ((first  cell  of  0PL1  =  first  cell  of  0PL2)  /♦  Paths  are  equivalent  if  first  */ 

or  (first  cell  of  0PL1  is  on  the  line  /*  pair  of  cells  are  equivalent  */ 

between  first  and  second  cells  of  0PL2) 
or  (first  cell  of  0PL2  is  on  the  line 
between  first  and  second  cells  of  0PL1) 
retum(TRUE); 
else  return  (FALSE); 

} 


/*  end  of  check-equivalent-paths  */ 


equivalent  according  to  the  above  definition,  tiie  edge  wliich  the  two  cells  share  is  considered  a  boundary  and 
is  added  to  a  list  of  boundaries. 

Since  each  cell  with  non-infinite  cost  is  on  the  wavefront  once  during  the  algorithm,  we  will  in  the 
end  check  each  cell  on  the  map.  For  two  adjacent  cells,  if  one  cell  is  has  been  reached  by  the  wavefront  and 
the  other  has  not  yet  been  readied,  the  second  cell’s  path  list  will  not  yet  be  determined,  so  a  boundary  check 
is  not  yet  possible.  But  when  the  second  cell  is  finally  put  on  the  wavefront,  its  path  list  is  set  and  a  check  of 
its  neighbors  will  consider  the  first  cell.  So  it  is  guaranteed  that  all  pairs  of  neighbors  will  be  checked  by  the 
end  of  the  algorithm,  and  all  boundaries  between  cells  will  be  delected. 

Note  that  references  to  the  start  point  have  been  deleted  from  the  algorithm,  since  we  are  looking  for 
paths  to  all  start  points.  The  initial  center  of  the  wavefront  is  called  the  goal  point.  Also,  there  is  no  possibility 
for  lire  algorithm  to  fail  because  of  an  inability  to  find  tire  start  point.  When  no  cells  remain  on  the  wavefront, 
tl>e  program  is  done.  Then  the  list  of  boundaries  will  be  transformed  into  tlie  appropriate  data  structure,  a  doub¬ 
ly-connected  edge  list,  and  the  path  information  will  be  transformed  into  an  optimal-path  tree. 

Tire  procedure  set-optimal-path-list  will  be  called  by  procedures  orthogonal-expand,  diagonal-ex- 
pand,  and  overflow  each  time  a  new  cel!  is  appended  onto  the  Cells-for-New-Wavefront  or  Overflow  lists 
respectively. 

Figure  14  (on  two  pages)  shows  tlie  result  of  applying  the  pure  definition  of  the  path-generalizing 
function  to  wavefront  propagation,  with  a  map  consisting  of  a  single  obstacle  and  a  single  high-cost  area.  The 
figure  shows  successive  snapshots  over  time  as  tlie  wavefront  expands  ami  the  back-pointers  are  set.  The 
wavefront  expands  from  tlie  goal  point  in  tlie  center,  and  back  pointers  show  die  opdmal  path  from  each  start 
point  to  die  goal  point.  Homogeneous-behavior  boundaries  arc  shown  as  doited  curves.  (Several  horizontal 
backpalhs  appear  darker  dian  die  odicis  otdy  because  of  die  resolution  of  the  printer  used.)  Figure  14a  shows 
die  first  tlirce  snapshots,  and  Figure  14b  shows  die  fourth  snapshot  and  a  final  frame  with  backpaths  removed 
for  clarity. 

Several  homogeneous-behavior  boundaries  in  Figure  14  arc  spurious,  that  is,  arc  not  predicted  by 
tlicorctical  anal)  sis.  (This  analysis  is  presented  in  Chapter  V.)  Near  tlie  upper  left  comer  of  die  high-cost  area, 
for  example,  (sec  Frame  5  in  Figure  14bi  three  straight  homogeneous-behavior  boundaries  emanate  from  a 
point  on  the  edge  of  the  high-cost  area,  one  is  vertical,  one  is  at  a  45°  angle,  and  one  is  horizontal.  The  latter 


two  of  these  boundaries  do  not  have  analogues  in  tlie  theoretical  case,  and  the  first,  analogous  to  the  "shadow" 
boundary  expected  at  that  vertex,  is  offset  from  the  vertex  of  the  high-cost  area  does  not  appear. 

Some  spurious  boundaries  are  generated  because  straight  lines  are  being  approximated  by  piecewise- 
linear  curves  in  the  eight  allowable  propagation  directions.  Several  examples  occur  to  the  right  of  the  high- 
cost  area  and  to  tlie  left  of  the  obstacle.  Multiple  parallel  boundaries  are  generated  by  the  upper-left  edge  of 
the  obstacle,  although  all  but  the  topmost  boundary  arc  spurious,  while  the  two  lower  boundaries  generated 
by  the  lower-left  edge  are  both  predicted  by  the  analysis  of  Chapter  V.  The  reason  for  the  difference  is  that 
the  lower-left  edge  is  positioned  at  a  45°  angle  to  the  vertical,  allowing  a  single  straight  path  to  lie  along  it. 
Thus  the  above  boundary-detection  heuristic  does  not  detect  spurious  boundaries  along  the  edge  because  there 
arc  no  turn  points  on  the  path.  But  the  upper-left  edge  lies  at  less  than  a  45°  angle  with  the  horizontal,  and  so 
the  path  along  it  must  "stair-step"  its  way  to  the  upper  vertex,  causing  boundaries  to  be  generated.  A  similar 
error  occurs  along  the  upper  right  and  lower  right  edges  of  the  iiigh-cost  area,  where  the  stair-step  nature  of 
the  edges  causes  spurious  exterior  boundaries  to  appear.  Further  spurious  boundaries  occur  in  the  inside  of  tlie 
high-cost  area,  and  outside  it  just  above  its  rightmost  vertex. 

Optimal-path  maps  generated  by  the  pure  wavefront  propagation  OPM  algorithm  will  be  useful  if 
tliesc  spurious  homogeneous-behavior  boundaries  do  not  matter.  But  there  are  approximately  twice  as  many 
boundaries  as  are  predicted  by  theoretical  analysis,  so  storage  and  run-time  speed  are  correspondingly  less  ef¬ 
ficient. 

2.  The  Diverging-Path  Version  of  Wavefront-Propagation  Optimal-Path-Map  Construction 
Another  approach  is  based  on  the  idea  that  two  adjacent  cells  whose  paths  diverge  should  be  in  dif¬ 
ferent  regions,  and  so  a  boundary  must  exist  between  them.  A  way  of  detecting  divergence  of  paths  is  to  check 
the  distance  between  tlie  /ilh-generation  ancestors  of  two  adjacent  cells.  If  the  ancestors  more  than  one  cell 
apart,  the  cells  arc  defined  as  diverging  paths.  In  other  words,  we  define  the  path-generalizing  function  so  that 
it  maps  cells  to  sets  of  paths  which  do  not  diverge. 

What  should  tlie  value  of  n  be?  In  other  words,  how  far  back  along  the  paths  of  the  two  cells  being 
compared  should  we  check?  If  n  is  small,  there  will  be  fewer  cliecks  to  perform,  enhancing  efficiency.  If  n  is 
large  some  small  terrain  features  may  be  overlooked  by  tlie  divergence  rule.  On  tlie  other  hand  if  n  is  large, 
we  can  handle  situations,  such  as  boundary  emanating  from  the  obstacle  in  Figure  J4b,  Frame  5,  where  back- 
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paths  may  parallel  each  other  for  some  distance  before  diverging.  But  this  situation  can  be  taken  care  of  by 
adding  a  second  condition  which  says  that  two  cells  are  in  different  regions  if  their  parents  are  in  different 
regions.  Even  with  this  rule,  however,  if  n  =  1 ,  there  are  situations  where  the  parents  of  two  cells  with  diverg¬ 
ing  paths  are  adjacent;  choosing  n  =  2  seems  to  give  the  best  results.  An  additional  necessary  heuristic  is  that 
two  paths  arc  in  different  regions  if  a  cell  between  the  two  ancestors  being  checked  is  a  terrain  feature  cell. 
This  handles  special  cases  such  as  very  acute  obstacle  vertices,  or  paths  on  opposite  sides  of  a  river.  Figure  15 
(on  two  pages)  shows  the  result  of  applying  these  heuristics  to  wavefront  propagation.  We  call  this  the  diver g- 
ing-path  version  of  the  wavefront-propagation  OPM-generation  algorithm. 

So  there  are  tliree  heuristics  used  in  the  diverging-path  version.  First,  adjacent  cells  whose  second- 
generation  ancestors  are  more  than  one  cell  apart  are  in  different  regions.  Second,  adjacent  cells  are  in  dif¬ 
ferent  regions  if  their  parents  arc  in  different  regions.  Third,  cells  are  in  different  regions  if  their 
second-generation  ancestors  have  a  terrain-feature  cell  between  them. 

Tliis  variant  algorithm  is  not  much  belter  than  the  pure  variant,  as  can  be  seen  by  studying  Figure 
15b,  Frame  5.  Here  too  few  boundaries  are  generated,  and  a  few  spurious  boundaries  appear  as  well.  Those 
boundaries  defined  in  Chapter  V  as  opposite-edge  boundaries,  i.e.,  boundaries  which  distinguish  between 
paths  which  go  in  opposite  directions  around  a  terrain  feature,  are  the  ones  best  detected  by  the  diverging-path 
version.  Shadow  boundaries,  i.e.,  boundaries  which  distinguish  between  paths  which  go  through  a  terrain-fea¬ 
ture  vertex  from  those  which  bypass  it,  are  not  detected  at  all.  Spurious  boundaries  arise  within  homogeneous- 
cost  areas.  The  homogeneous-cost  area  in  Figure  15  has  spurious  boundaries  just  above  its  rightmost  vertex. 
But  for  purely  binary  terrain,  i.e.,  obstacles  on  a  homogeneous-cost  background,  the  diverging-path  version 
may  be  appropriate. 

3.  The  Vertex-Edge  Version  of  Wavefront-Propagation  Optimal-Path-Map  Construction 

Any  variant  algoritlim  that  relics  solely  on  the  turns  in  a  path  will  misinterpret  some  turns  as  due  to 
lire  terrain  when  in  fact  they  were  due  only  to  the  mechanics  of  tire  algoritlim  (e.g.,  tire  eight  propagation  direc¬ 
tions),  and  vice  versa.  Also,  lire  diverging-path  variant  only  detects  a  certain  class  of  boundary.  A  way  to  at¬ 
tack  both  of  these  problems  is  to  plot  boundaries  based  on  how  terrain-features  affect  optimal  paths. 

In  terrain  u  ith  piccew  ise- linear  edges  in  homogeneous-cost  background,  optimal  paths  will  turn  only 
at  terrain  feature  vertices  or  edges  (Tlieorem  1-2,  Appendix  A).  Thus,  if  a  turn  in  a  path  occurs  at  other  than  a 


58 


vertex  or  edge,  it  must  be  turning  based  on  algorithm  mechanics  alone.  So  we  could  check  whether  or  not  a 
turn  point  in  a  path  is  adjacent  to  a  terrain-feature  vertex  or  occurs  at  the  edge  of  a  homogeneous-cost  region. 
We  could  define  the  path-generalizing  function  as  mapping  a  cell  to  a  list  of  the  terrain-feature  vertices  and 
edges  at  which  its  optimal  path  turns.  We  can  say  that  a  path  turns  at  a  vertex  or  edge  if  the  turn  cell  is  ad¬ 
jacent  to  or  the  same  as  the  vertex  or  edge  cell. 

This  approach  requires  some  additional  terrain  preprocessing.  Since  terrain  in  the  two  previous  ver¬ 
sions  has  been  represented  entirely  as  individual  cells,  some  way  of  finding  and  representing  terrain-feature 
edges  and  vertices  will  become  necessary.  Such  a  preprocessing  algorithm  could  group  cells  into  terrain  fea¬ 
tures  of  homogeneous  cost,  and  then  fit  polygons  to  each  feature.  For  each  vertex  of  the  polygon,  it  could  find 
the  closest  corresponding  cell  in  the  original  representation  and  label  it  as  a  vertex.  For  each  edge  of  the 
polygon,  it  could  find  which  cells  most  closely  corresponded  to  it  and  label  them  as  lying  on  that  edge.  Wade 
[Ref.  44]  presents  an  algorithm  fordoing  such  terrain  preprocessing. 

So  we  redefine  "path  list"  to  include  only  vertex  and  edge  descriptors.  To  do  this,  turn  cells  are  check¬ 
ed  to  see  if  they  arc  adjacent  to  a  terrain-feature  vertex  or  edge.  This  procedure  may  create  a  spurious  bound¬ 
ary  if  a  path  turns  twice  within  one  cell  of  a  vertex,  a  case  which  would  happen  at  a  comer  which  formed  a 
very  acute  angle,  for  example,  a  river  end.  In  this  case,  a  spurious  boundary  would  lie  along  the  side  of  the 
river  segment  away  from  tire  start  point.  We  must  also  specify  from  which  side  a  path  crosses  an  edge,  be¬ 
cause  a  path  may  leave  an  area  across  an  edge  and  then  reenter  it  across  the  same  edge.  This  type  of  path  is  il¬ 
lustrated  in  Figure  16b,  Frame  4,  starting  at  the  cell  labeled  A.  The  path  from  A  has  a  path  list  [A,C,D,GJ, 
while  a  path  from  cell  B  has  a  path  list  [C,D,GJ.  When  comparing  cells  A  and  C  (the  first  cells  on  the  two 
paths)  to  determine  if  A  and  B  have  a  boundary  between  tliem,  we  must  be  able  to  determine  that  the  first  path 
crosses  out  of  tire  liigh-cost  area  at  A,  while  the  second  path  crosses  into  the  area  at  C,  and  so  the  paths  have 
different  behavior.  This  set  of  heuristics  provides  lire  ability  to  detect  boundaries  inside  homogeneous-cost 
areas,  across  rivers,  and  across  roads.  The  procedures  set-optimal-path-list  and  check-equivalent -paths are 
listed  in  Table  2  with  the  appropriate  changes. 

Figure  16  shows  the  above  heuristics  in  operation.  TJierc  is  a  very  close  correspondence  between  tire 
boundaries  of  Figure  J  6b,  Frame  5.  and  the  theoretically  correct  boundaries  for  an  exact  optimal-path  map. 
Few  spurious  boundaries  are  generated.  For  example,  lire  re  are  too  many  boundaries  emanating  from  (lie  far 
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TABLE  2 

WAVEFRONT-PROPAGATION  OPM  ALGORITHM 
CHANGES  FOR  VERTEX-EDGE  VERSION 


procedure  set-optimal-path-list 
input:  Cell 


/♦  REVISED  PROCEDURE  */ 


( 

if  (Parent  of  Cell  is  on  Edge;  and  OPL-Parent  of  /*  include  a  cell  in  OPL  for  each  boundary-  */ 

Parent  of  Cell  is  not  on  Edgei)  /*  crossing  episode.  */ 

OPL-Parent  of  Cell  :=  Parent  of  Cell; 

else  if  (Parent  of  Cell  is  on  line  segment  between  /*  SAME  AS  PREVIOUS  VERSION  */ 

Cell  and  OPL-Parent  of  Parent  of  Cell) 

OPL-Parent  of  Cell  :=  OPL-Parent  of  Parent  of  Cell; 
else 

OPL-Parent  of  Cell  :=  Parent  of  Cell; 


) 


/*  end  of  optimal-path-list  */ 


procedure  check-equivalent-patlis  /*  REVISED  PROCEDURE  */ 

input:  0PL1,  the  OPL-Parent  of  Neighbor-Cell 
and  0PL2,  the  OPL-Parent  of  Current-Cell 
output:  returns  TRUE  if  paths  are  equivalent,  FALSE  otherwise. 

I 

if  (0PL1  =  0PL2  =  [goal-point]) 
retunuTRUE): 
else 
( 

for  i  =  1  to  2 

until  ((first  cell  of  OPL;  is  adjacent  to 
a  cell  marked  "vertex")  or  (first  cell  of 
OPLi  is  marked  "edgcj")) 

OPLj  :=  OPLi  less  first  cell; 
if  ((first  cell  of  OPLI  =  first  cell  of  0PL2) 
or  (first  cell  of  OPLI  is  on  tire  line 
between  first  and  second  cells  of  0PL2) 
or  (first  cell  of  0PL2  is  on  the  line 
between  first  and  second  cells  of  OPLI) 
or  ((edgei  =  edgej)  and 
check-equivaient-patlu(OPLl  less  first 
cell,  0PL2  less  first  cell)) 

Boundary-Flag  :=  TRUE: 
else  Boundary-Flag  :=  FALSE; 


/♦  Consider  only  cells  which  are  */ 

I*  adjacent  to  terrain-feature  vertices  */ 
/*'  or  represent  edge-crossing  episodes 
I*  Paths  are  equivalent  if  each  */ 

/♦  pair  of  cells  are  equivalent  */ 


/♦  NEW  CONDITION  */ 


I 


/*  end  of  check-equivalent-paths  *1 
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Figure  J6a 

Example  of  Vertex-Edge  OPM  Version  of  Wavefront  Propagation 


Figure  16b 

Example  of  Vertex-Edge  OPM  Version  of  Wavefront  Propagation 
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right  vertex  of  the  liigh-cost  area,  And  few  boundaries  are  overlooked,  although  some  shadow  boundaries  do 
not  appear.  For  example,  a  shadow  boundary  should  emanate  from  the  lower  right  vertex  of  the  obstacle;  in 
Chapter  V  we  develop  analytic  characterizations  of  homogeneous-behavior  boundaries  and  find  that  the  linear 
boundaries  incide  t  upon  vertices  should  act  as  if  they  were  shadows  with  the  goal  acting  as  a  point  light 
source  Also,  the  cur -ed  boundaries  on  the  hidden  side  of  obstacles  should  be  hyperbolas,  and  the  curved  boun¬ 
daries  inside  homogeneous-cost  areas  should  have  monotonic  curvature.  From  these  comments,  ii  can  be  seen 
that  the  ooundaries  generated  by  the  vertex-edge  version  (as  well  as  the  other  versions  of  wavefront  propaga¬ 
tion)  have  some  error  in  location  and  shape,  although  they  may  suffice  for  many  applications. 

C.  RECONSTRUCTING  OPTIMAL  PATHS  FROM  WAVEFRONT  PROPAGATION 
OPTIMAL-PATH  MAPS 

How  can  wc  teconstnict  the  optimal  path  from  the  start  point  knowing  the  node  of  the  optimal-path  tree 
wiiich  describes  its  behavior?  The  answer  depends  on  what  information  is  available  in  the  nodes,  which  will 
be  different  depending  on  lire  version  ol  w„.e£ront  propagation,  because  homogeneous-behavior  regions  are 
defined  differently  for  each  version.  For  the  pure  or  diverging-path  version,  each  optimal-palh-lree  node  rep¬ 
resents  a  single  cell.  Because  intermediate  turn  cells  on  the  portion  of  a  path  which  lies  within  a  homogeneous- 
behavior  region  arc  a  result  of  the  mechanics  of  the  algorithm,  and  not  of  terrain-feature  influence,  a  path  can 
be  approximated  by  plotting  straight  lines  from  a  start  cull  to  the  cell  of  the  node  representing  the  region  in 
which  the  start  cell  lies,  another  straight  line  from  that  cell  to  its  parent  in  the  optimal-path  tree,  and  so  on  back 
to  the  goal  This  type  of  path  no  longer  conforms  to  the  grid-based  model;  otherwise,  some  "stair-step"  ap¬ 
proximation  of  the  line  would  be  required.  By  Tliccrem  1-2,  in  the  type  of  terrain  considered  herein,  paths  arc 
straight-line  segments  except  at  terrain-feature  vertices  oredges.  So  the  vertex-edge  version  can  use  the  above 
method  for  paths  from  start  cells  to  nodes  representing  vertices,  and  between  vertices.  Between  edges,  further 
processing  would  be  necessary  to  determine  where  along  an  edge  a  given  path  would  cross  using  Snell's  Law 
as  discussed  in  Chapter  II. 
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IV.  ANALYSIS  OF  WAVEFRONT-PROPAGATION  OPM-GENERATION 

ALGORITHMS 


A.  SOURCES  OF  ERROR  IN  WAVEFRONT-PROPAGATION  OPM-GENERATION 
ALGORITHMS 

A  problem  with  using  wavefroot  propagation  to  generate  optimal-path  maps  is  that  the  inherent  error  of 
the  algorithm  is  carried  forward  to  the  OPM.  As  stated  previously,  Richbourg  [Ref.  20]  showed  that  an  upper 
bound  on  the  error  factor  of  the  cost  of  a  model-optimal  path  generated  by  the  point-to-point  wavefront 
propagation  algorithm  compared  with  tire  cost  of  the  corresponding  real-world  optimal  path  is  cos(7t/8),  or 
about  7.6%.  Tlie  fact  that  the  sliapes  of  boundaries  generated  by  wavefront  propagation  are  only  approxima- 
tioas  of  the  correct  shapes  derived  in  Chapter  V  reflects  the  error  in  the  shape  and  cost  of  optimal  paths  in¬ 
herent  in  wavefront  propagation. 

The  optimal-path  map  in  our  approach  does  not  retain  information  about  all  the  intermediate  cells  where 
each  path  turns,  and  so  we  cannot  reproduce  the  path  exactly  as  generated  by  wavefront  propagation.  If  we 
could,  however,  tire  upper  bound  on  percent  error  of  7.6%  would  remain  in  effect,  because  nothing  in  the  OPM 
algorithms  of  Chapter  111  affected  how  the  wavefront  expanded  from  cell  to  cell.  The  backpaths  of  Figures  14, 
15,  ar<d  16  are  all  identical  (compare  Frame  4  of  each  figure),  and  only  the  boundaries  differ.  Although  we 
cannot  reconstruct  a  path  exactly  as  generated  by  wavefront  propagation,  the  straight-line  approximation 
method  proposed  in  Section  C  of  Chapter  III  actually  produces  a  path  as  good  or  better  in  cost  than  the 
wavefront  propagation  path.  Straight-  line  approximations  of  a  path  always  go  through  the  region  root,  which 
was  on  the  original  path.  They  also  lie  completely  within  an  area  of  homogeneous  cost,  because  homogeneous- 
behavior  regions  arc  star-shaped  with  respect  to  the  region  root  (Corollary  1-1.4).  By  the  triangle  inequality, 
their  cost  is  always  less  than  or  equal  tc  lire  original  path.  So  since  costs  of  straight-line  approximations  are 
lower  bounds  on  costs  of  wavefront-generated  paths,  tire  previously  stated  upper  bound  on  percent  error 
remains  3  valid  upper  bound.  Can  tills  upper  bound  be  improved? 

Although  in  the  case  of  most  start  cells,  substantial  improvement  over  the  cost  of  model-optimal  paths 
generated  by  wavefront  propagation  will  be  achieved  by  tliis  patli  reconstruction  method,  the  upper  bound  on 


66 


error  cannot  be  tightened  in  general,  because  there  will  be  situations  where  the  error  in  placement  of  a  bound¬ 
ary  would  cause  a  start  point  to  be  placed  in  an  incorrect  region,  (although  without  exceeding  the  upper  bound). 
An  example  of  such  a  case  occurs  in  Frame  5  of  Figure  1 6,  at  the  point  labeled  X.  The  optimal  path  from  point 
X  should  be  a  straight  line  to  die  goal.  But  since  wavefront  propagation  caused  error  in  the  placement  of  the 
vertical  boundary  (it  should  have  been  a  "shadow  boundary,"  a  ray  from  the  upper  left  vertex  of  the  high-cost 
area  extending  direedy  away  from  the  goal  point),  X  is  to  the  right  of  the  vertical  boundary  instead  of  to  its 
left,  so  it  is  associated  with  the  region  whose  root  is  the  top-left  edge  of  the  high-cost  area.  Thus,  a  reconstructed 
path  will  go  in  a  straight  line  to  the  top  of  the  high-cost  area,  and  then  cut  across  its  comer  and  go  the  the  goal. 
This  path  has  a  cost  error  close  to  the  original  upper  bound. 

Thus  the  upper  bound  on  percent  error  of  die  cost  of  wavefront-propagation-generated  model-optimal 
paths  with  respect  to  real-world  optimal  paths  remains  as  stated  for  the  point-to-point  version  of  the  algorithm, 
i.e.,  7.6%,  although  average  error  will  be  improved  by  appropriate  reconstruction  of  paths  from  the  optimal- 
path  map. 

B.  TIME  COMPLEXITY  OF  WAVEFRONT-PROPAGATION  OPM-GENERATION 
ALGORITHMS 

As  stated  in  Chapter  II,  point-to-point  wavefront  propagation  implemented  using  Dijkstra's  algorithm  has 
worst-case  rime  complexity  0(m  log  in),  where  Uierc  arc  m  cells  in  the  input  map.  In  Algorithms  B-l  (Appen¬ 
dix  B)  and  ID-1  (Chapter  III),  however,  the  algoridim  is  modelled  on  the  wavefront  analogy,  and  Dijkstra’s 
algoritiim  is  not  followed  exactly  (because  cells  may  remain  on  the  wavefront  for  more  than  one  iteration,  and 
a  search  for  die  minimum-cost  edge  is  not  dune  for  each  wavefront).  As  explained  in  Chapter  II,  the  time  com¬ 
plexity  of  diis  version  is  0(c  nt).  where  c  is  the  maximum  cost  of  a  cell  in  the  input  map,  rime  is  incremented 
by  1  unit  each  step,  and  it  is  assumed  that  there  is  some  upper  bound  on  the  size  of  c. 

The  mechanism  for  detecting  boundaries  is  to  check  each  cell  on  the  wavefront  against  each  of  its  eight 
neighbors.  There  arc  eight,  or  O(constant)  checks  for  each  of  the  m  cells  in  the  map.  Each  boundary  check  m 
tl>c  /'me  version  consists  of  an  O(constant)  comparison  of  die  first  turn  points  on  the  backpalhs  of  the  two  cells 
being  checked  So  boundary  -checking  takes  O(m)  time.  This  is  added  to  the  time  for  the  basic  algorithm,  so 
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(tie  pure  version  of  wavefront-propagation  optimal-palh-map  generation  has  the  same  asymptotic  worst- case 
time  complexity  as  point-to-point  wavefront  propagation,  or  0(c  m). 

In  the  diverging-path  version  of  wavefront-propagation  optimal-path-map  generation,  the  boundary  check 
consists  of  a  comparison  of  the  distance  between  the  parents  of  the  parents  of  the  two  cells.  Again  it  is  an 
O(constant)  operation  to  follow  two  back-pointers  for  each  cell  and  compute  a  distance,  so  boundary-check¬ 
ing  takes  O(m)  time,  and  the  diverging-path  version  is  also  0(c  m). 

The  vertex-edge  version  of  wavefront-propagation  optimal-path-map  generation  uses  the  same  path  lists 
as  the  pure  version,  but  considers  only  so-called  distinguished  cells  on  the  lists.  A  check  of  tlie  first  two  dis¬ 
tinguished  cells  in  a  path  list  by  procedure  check-equivalent-paths  will  give  a  conclusive  answer  about 
whether  or  not  two  paths  are  "similarly  behaved".  This  check  is  an  O(constant)  process  where  the  first  element 
in  each  list  is  retrieved,  and  the  two  elements  compared.  So  tlie  vertex-edge  version  also  has  worst-case  time 
complexity  0(c  m). 

As  discussed  in  Chapter  III,  the  vertex-edge  version  requires  preprocessing  of  the  terrain  to  fit  groups  of 
homogeneous-cost  cells  to  polygons  or  line  segments,  and  to  find  vertices  and  edges.  The  algorithm  of  Wade 
and  Rowe  [Ref.  44]  which  does  this  has  two  passes.  The  first  pass  processes  each  cell  once,  in  total  0{m)  time. 
Tlie  second  pass  is  recursive,  and  a  worst-case  time  complexity  is  not  given,  but  for  a  map  with  k  edge  cells, 
is  approximately  Oflog  k).  Under  the  above  assumptions,  the  number  of  edge  cells  is  significantly  less  than 
the  number  of  cells,  so  k<m.  Therefore  the  terrain  preprocessing  is  dominated  by  the  wavefront  propagation 
algorithm. 

C.  SPACE  COMPLEXITY  OF  WAVEFRONT-PROPAGATION  OPM-GENERATION 
ALGORITHMS 

The  space  required  for  the  point-to-point  wavefront  propagation  algorithm  is  simply  O(m),  where  tlie 
input  map  has  m  cells.  Storage  is  usually  implemented  by  a  Vm  by  Vm  array  which  holds  cost  information 
and  a  pointer  to  the  parent  of  the  cel!  on  its  backpath.  During  execution,  another  data  structure  will  hold  the 
coordinates  of  those  cells  currently  on  the  wavefront.  When  the  algorithm  is  expanded  to  deal  with  the  two- 
dimensional,  or  optimal-path-map  case,  several  new  Jata  structures  must  be  added.  First,  for  tlie  pure  and  the 
vertex-edge  versions,  two  fields  must  be  added  to  tlie  cell  array  to  hold  the  coordinates  of  the  cell's  parent  on 
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the  optimal-path  list  (in  general  not  the  cell's  parent  on  the  backpath).  Secondly,  new  data  structures  must  be 
added  to  hold  the  output.  These  data  structures  are  the  DCEL  and  the  optimal-path  tree. 

As  explained  in  Chapter  II,  Section  B,  a  doubly-connected  edge  list  (DCEL)  along  with  an  optimal-path 
tree  are  well  suited  to  representing  the  optimal-path  map.  The  size  of  the  optimal-path  tree  is  proportional  to 
tlie  number  of  homogeneous-behavior  regions  in  the  optimal-path  map,  since  there  is  one  node  per  region. 
Since  in  tire  worst  case  there  could  be  no  more  than  one  region  per  cell,  the  optimal-path  tree  will  never  re¬ 
quire  more  than  0(m)  storage.  In  fact  as  discussed  above,  the  number  of  regions  is  assumed  to  be  significant¬ 
ly  larger  than  the  number  of  cells,  so  the  optimal-path  tree  will  only  require  a  small  fraction  of  the  total  number 
of  cells  in  llie  input  map,  and  is  more  accurately  a  function  of  the  number  of  terrain  feature  vertices  and  edges, 
or  ()(v  +  c ). 

The  DCEL  represents  the  planar  partition  by  listing  characteristics  of  each  line  segment,  or  edge,  in  the 
partition.  Since  each  segment  of  the  wavefront-propagation-OPM  boundaries  is  designated  as  lying  between 
two  specified  cells,  there  can  never  be  more  titan  0(nt)  boundary  segments,  and  in  fact,  the  one-dimensional 
nature  of  boundaries  will  tend  to  produce  an  DCEL  of  O(Vm)  size.  In  terms  of  terrain-feature  vertices  and 
edges,  it  is  shown  in  Chapter  V  that  any  given  vertex  or  edge  has  a  constant  number  of  region  boundaries  as¬ 
sociated  with  it,  so  the  DCEL  will  have  size  of  0(v  +  e).  Note  that  the  O(m)  input  map  can  be  discarded  after 
preprocessing,  so  the  amount  of  storage  needed  at  run-time  will  be  0(v  +  e). 

In  practice,  a  great  amount  of  storage  can  be  saved  in  the  way  the  planar  partition  is  represented  by  the 
DCEL.  As  produced  by  the  wavefront-propagation  OPM-generation  algorithm,  boundaries  are  represented  by 
lists  of  cell  edges  (perhaps  implemented  simply  by  listing  coordinates  in  the  same  coordinate  system  as  the 
cells,  but  incremented  or  decremented  by  .5).  But  in  fact,  boundaries  in  the  grid-based  domain  typically  con¬ 
tain  long,  near-linear  sequences,  so  the  number  of  edges  in  tlx:  DCEL  can  be  reduced  greatly  by  representing 
only  endpoints  of  such  sequences.  Figure  1 6  shows  about  half  of  the  boundaries  to  be  linear. 

D.  EMPIRICAL  PERFORMANCE  OF  WAVEFRONT-PROPAGATION  OPM 
IMPLEMENTATIONS 

The  three  versions  of  the  OPM-generation  algoritlim  described  in  Section  B  of  Cnaplcr  III  were  imple¬ 
mented  :n  Common  Lisp  on  a  Symbolics  3620  Lisp  Machine.  Although  no  special  effort  was  made  to  make 


these  implementations  efficient,  some  idea  of  the  relative  performance  of  the  four  versions,  and  some  rough 
idea  of  the  performance  of  wavefront  propagation  in  general,  can  be  gained  by  observing  actual  run-times. 
Table  3  shows  average  elapsed  times  for  two  typical  input  maps,  based  on  the  Lisp  function  "gel-universal¬ 
time".  These  real-time  figures  give  some  rough  idea  of  the  actual  performance  of  these  implementations. 
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TABLE  3 


WAVEFRONT-PROPAGATION  OPM-GENERATION 
RELATIVE  PERFORMANCE  OF  THREE  VERSIONS 


MagMumtor 

Pure  PPM 

Version 

Divereing-Path 

Version 

Yeflsa-Edgg 

Version 

i 

(average  CPU  Time) 
(average  Real  Time) 

449,759  cycles 

493  sec 

793,094  cycles 

843  sec 

2,292,827  cycles 

2,440  sec 

2 

(average  CPU  Time) 

(average  Real  Time) 

1,558,722  cycles  916,535  cycles 

1,714  sec  973  sec 

2,013,910  cycles 

2113  sec 

NOTES: 

(1)  Average  CPU  Time  is  elapsed  time  as  per  maclrine-dependent  LISP  function  "get-intemal-run-time" 
averaged  over  eight  runs. 

(2)  Average  Real  Time  is  elapsed  time  as  per  LISP  function  "get-universal-time"  averaged  over  eight  runs. 

(3)  Versions  were  implemented  in  Common-Lisp  on  a  Symbolics™  3640  operating  under  Genera  4.1™. 

(4)  Map  1  was  199  by  150  cells  (i.e.,  29850),  with  one  obstacle  and  one  high-cost  feature,  12  vertices  and 
12  edges,  with  465  cells,  or  1.5%,  of  infinite  cost  (obstacle  cells)  and  741  cells,  or  2.5%,  of  cost  two. 

(5)  Map  2  was  199  by  150  cells  (i.e.,  29850),  wilii  lliree  obstacles,  15  vertices  and  15  edges,  with  619  cells, 
or  2.1%,  of  infinite  cost. 
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V.  CHARACTERIZATION  OF  REGION  BOUNDARIES 


In  this  chapter,  wc  formulate  the  geometrical  groundwork  necessary  for  an  OPM  construction  algorithm 
which  relics  on  spatial  reasoning  to  eliminate  much  of  the  inaccuracy  inherent  in  the  wavefront  propagation 
OPM  construction  algorithm.  The  algorithm  applies  to  maps  consisting  of  the  five  types  of  terrain  defined  in 
Giapter  I,  Section  E,  obstacles,  roads,  rivers,  homogeneous-cost  areas  (HCA),  and  homogeneous-cost  back¬ 
ground.  The  approach  we  use  is  to  determine  the  analytic  characteristics  of  boundaries  between  regions  of 
similarly-behaved  optimal  paths  as  functions  of  terrain  feature  characteristics.  It  turns  out  that  all  boundaries 
associated  with  the  first  three  of  the  above  terrain  feature  types  (roads,  rivers,  and  obstacles)  are  segments  of 
conic  sections.  Boundaries  associated  with  HCA’s  are  more  mathematically  complex,  and  in  many  cases  do 
not  appear  to  have  closed-fonn  expressions.  In  addition  to  the  algebraic  form  of  these  boundaries,  we  develop 
the  theory  which  describes  the  circumstances  in  which  each  type  of  boundary  occurs.  The  algorithms  described 
in  Chapter  VI  will  rely  on  the  results  developed  in  this  chapter  for  the  basic  steps  involving  construction  of 
each  boundary. 

First, primitive  terrain  features,  that  is  single  polygonal  obstacles  and  homogeneous-cost  areas,  andsingle 
river  and  road  iine  segments,  are  studied  and  the  boundaries  they  generate  are  characterized.  Then  a  unifying 
theory  is  introduced  which  urn.'  •  dies  all  types  of  boundaries  as  they  occur  in  terrain  as  defined  herein.  Develop¬ 
ment  of  algorithms  for  constructing  OPM’s  for  each  of  the  primitive  terrain  features  and  for  combined  terrain 
is  deferred  until  Chapter  Vi.  Appendix  C  contains  additional  examples  of  optimal-path  maps  for  each  of  the 
primitive  terrain  features  presented. 

A.  REGION  BOUNDARIES  ASSOCIATED  WITH  PRIMITIVE  TERRAIN  FEATURES 

Table  4  summarizes  the  types  of  homogeneous-behavior-region  boundaries  associated  with  each  type  of 
primitive  terrain  feature.  Each  type  of  terrain  feature  is  listed  in  the  left  column.  The  second,  third,  fourth,  and 
fifth  columns  contain  tire  names  of  tire  boundary  types  associated  with  that  terrain  feature  wliich  are  linear, 
parabolic,  hyperbolic,  and  non-conic  respectively.  Since  there  are  four  cases  of  homogeneous-cost  area  (HCA) 
depending  on  whe'iicr  the  goal  is  inside  or  outside  tlte  HCA  and  on  whether  lire  HCA  cost  is  higirer  or  lower 
than  tire  surrounding  terrain,  each  of  which  has  distinctively  different  boundaries,  these  four  cases  arc  listed 
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TABLE  4 


SUMMARY  OF  HOMOGENEOUS-BEHAVIOR-REGION 
BOUNDARIES  BY  TERRAIN  TYPE 


FORM  OF  BOUNDARY 


LINEAR 

PARABOUC 

HYPERBOLIC 

NQN-.CQNIC 

Obstacle 

Shadow(c/c) 

Obstacle-edge 

Opposite-edge(c/c) 

River  Segment 

Shadow(c/c) 

River-edge 

River-opposite-edge(c/c) 

River-crossing(c/c) 

Road  Segment 

Road-edge 

Rd-end/road- 

tvlg(c/p) 

Rd-tvlg/road- 

crossing(p/c) 

Shadow(c/c) 

Near-side-road- 

travelling/goal(p/c) 

Far-side-road- 

travelling/goal(p/c) 

Road-end/goal(c/c) 

High-Cost 
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separately.  Also  listed  with  each  boundary  name  is  a  coded  description  of  what  type  of  cost  functions  are  as¬ 
sociated  with  tl>e  homogeneous-behavior  regions  on  either  side  of  the  boundary.  The  code  "c"  means  the  cost 
function  of  a  region  is  conical,  "p"  means  it  is  planar,  and  "d"  means  it  is  a  "distorted  cone".  Terrain-feature 
edges  always  fomi  boundaries,  which  of  course  are  linear  since  terrain-feature  edges  are  linear,  but  are  not  as¬ 
sociated  with  a  particular  cost  function,  so  no  code  is  shown.  (See  Section  C  for  a  discussion  of  cost  functions.) 

1.  Obstacles 

V':  begin  by  characterizing  boundaries  associated  with  a  single  obstacle  in  homogeneous-cost  back¬ 
ground  terrain  (see  Theorem  V-l,  Appendix  A).  (Tire  types  of  boundaries  associated  w..h  obstacles  have  pre¬ 
viously  been  determined  by  Mitchell  [Ref.  4]  using  different  terminology.)  Wiu*  respect  to  obstacles,  define 
a  visible  edge  to  be  an  edge  for  which  no  point  on  tlie  edge  has  an  optimal-path  list  whose  first  element  lies 
on  the  obstacle  perimeter.  Define  a  hidden  edge  as  a  nou-yisible  edge,  i.e.,  an  edge  for  which  some  point  on 
the  edge  has  an  optimal-path  list  whose  first  element  lies  on  the  obstacle  perimeter.  In  the  case  of  terrain  con¬ 
taining  only  a  single  obstacle,  this  means  that  both  visible-edge  vertices  are  visible  to  the  goal  point.  In  Figure 
17,  edges  AB  and  BC  arc  visible  edges.  Edges  CD,  DE,  and  EA  are  hidden  edges.  (Many  of  the  following 
figures  are  similar  in  format.  Terrain  features  are  shown  as  polygons  or  line  segments.  Homogeneous-behavior- 
region  boundaries  are  shown  as  solid  curves.  Occasionally  continuations  of  the  boundaries  are  shown  as  dashed 
lines  to  clarify  the  form  of  a  boundary.  In  many  of  the  figures  a  field  of  small  vectors  represents  the  initial 
direction  .-t  he  ptimal  pailis  from  a  sampling  of  start  points.  These  fields  are  not  part  of  the  optimal-path 
map,  but  sca'c  to  illustrate  the  directions  patlis  take  and  to  corroborate  the  correctness  of  plotted  boundaries.) 
Define  an  opposite  edge  to  be  the  obstacle  hidden  edge  for  which  the  optimal  path  lists  of  neither  vertex  in¬ 
cludes  the  otter.  An  isolated  obstacle  has  exactly  ette  opposite  edge  (lemma  V-l. 3,  Appendix  A).  Edge  DE 
is  tlie  opposite  edge  in  Figure  17.  A  special  case  is  that  its  which  the  role  of  the  opposite  edge  is  assumed  by 
an  obstacle  vertex"  this  is  ruled  out  by  tlr  '  .ncral  position  assumption  discussed  in  Chapter  I,  although  she 
analysis  foi  including  such  a  case  is  a  simple  extension  of  the  below.  Define  an  opposite  point  as  the  point  on 
tlie  opposite  edge  with  two  distinct  optimal  paths,  one  tlirough  each  vertex  of  lire  opposite  edge. 

There  arc  three  types  of  boundaries  associated  with  obstacles.  Obstacle  edges  are  trivial  boundaries, 
since  they  separate  regions  wlrose  optimal-path  lists  are  l[J, .goal-point]  from  regions  with  nun-degenerate  op¬ 
timal-path  lists  (see  Lemma  V-l.  1 1.  Obsun  'e  shadows  emanate  from  vertices  of  hidden  edges  in  n  straight 
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Figure  17 
Obstacle 


line,  as  if  trie  goal  were  a  point  light  source;  each  vertex  of  a  hidden  edge  generates  a  shadow  boundary.  For 
those  vertices  wliich  join  a  hidden  edge  and  a  visible  edge,  the  line  segment  lies  on  the  line  defined  by  the  ver¬ 
tex  and  the  goal;  for  those  vertices  which  join  two  hidden  edges,  the  line  segment  lies  on  the  line  defined  by 
that  vertex  and  the  vertex  of  the  hidden  edge  which  is  included  in  the  first  vertex’s  optimal  path.  (See  Figure 
17  and  Lemma  V-1.2,  Appendix  A). 

Each  obstacle  also  has  exactly  one  opposite-edge  boundary  wliich  emanates  from  the  opposite  edge 
of  an  obstacle,  and  consists  of  segments  of  hyperbolas.  This  follows  directly  from  the  definition  of  a  bound¬ 
ary  by  the  application  of  basic  analytical  geometry  (see  lemma  V-l  .4,  Appendix  A).  The  hyperbola  is  defined 
by  considering  the  vertices  V  j  and  V2  of  the  opposite  edge  us  foci.  Choosing  a  coordinate  system  such  that 
the  x-axis  intersects  both  foci  and  the  origin  is  mid-way  between  them,  Equation  1  describes  the  opposite-edge 
boundary.  Forcing  constant  a  to  be  positive  restricts  Equation  1  to  the  one  branch  of  the  hyperbola  which  is 
closer  to  the  higher-cost  focus.  The  segment  of  this  branch  which  is  active  as  a  boundary  begins  at  the  point 
on  tire  opposite  edge  intersected  by  t!tc  branch  and  continues  away  from  the  obstacle.  (See  Figure  17). 


(Equation  1 ) 


~2  .  »  c2  where  a  =  (1GV2I - IGV|l)/2,  IGV2I>IGV|I, 

3  ckIVjW.,  and  b2  =  c2  -  a2. 


If  at  any  point  the  opposite-edge  boundary  intersects  a  shadow  boundary,  it  will  become  defined  by 
another  hyperbola  from  that  point  on.  This  second  hyperbola  is  defined  by  considering  as  foci  (1)  the  vertex 
of  the  edge  associated  wit!;  the  shadow  boundary  and  which  is  the  closer  to  the  goal  of  the  two  vertices  of  that 
edge,  and  (2)  the  focus  of  the  previous  hyperbola  which  is  not  also  a  vertex  of  the  edge  associated  with  tlic 
shadow.  The  hyperbolic  constant  is  computed  as  before,  using  the  costs  from  the  foci  to  tlie  goal.  Tire  segment 
begins  at  the  point  where  the  second  hyperbola  intersects  the  first  hyperbola,  and  continues  away  from  the 
obstacle.  The  dirccuon  of  curvature  of  the  second  hyperbola  may  be  tire  same  or  opposite  that  of  the  first-  (See 
Figure  17). 

1  D  1  iia**  Cn^i  m  Anir 
*1  >\i*  vi  uv^mvmo 

Single  isolated  river  segments  generate  four  types  of  boundaries  (see  Figure  18  and  Theorem  V-2, 
Appendix  A >.  Rncr -edges  arc  triv  ial  boundaries  (Lemma  V-2.1 ).  Shadow  boundaries  are  associated  w  ilh  each 
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Figure  18 
River  Segment 
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river  vertex,  and  are  half-lines  starting  at  a  river  vertex  and  lying  directly  away  from  the  goal  (Lemma  V-2.2). 
River-crossing  boundaries  differendate  between  paths  that  cross  a  river  and  ones  that  go  around  its  end.  A 
river-crossing  boundary  is  a  segment  of  a  hyperbola  defined  by  considering  the  river  vertex  Vaa  „■  Ooal  G 
as  foci,  with  the  constant  in  Equation  1  being  a  =  IVGI/2.  The  segment  begins  at  the  point  at  which  the  hyper¬ 
bola  intersects  the  river  and  ends  at  the  point  at  which  it  intersects  the  river-obstacle  boundary  (below).  This 
type  of  boundary  may  not  appear  if  the  river-crossing  cost  is  too  high  or  if  the  angle  between  the  river  and  the 
goal-to-river-end  line  approaches  or  exceeds  90°.  (Lemma  V-2.3).  A  river  segment  will  act  like  an  obstacle 
when  the  distance  of  the  start  point  to  the  river  plus  the  river-crossing  cost  is  large  compared  with  the  distance 
from  the  river  to  the  goal.  If  tills  occurs,  a  boundary  will  start  at  the  intersecdon  of  the  two  river-crossing  boun¬ 
daries,  if  they  exist,  or  if  not  at  the  river  edge.  This  opposite-edge  boundary  will  be  a  hyperbola  defined  by  the 
two  river-end  vertices  V 1  and  V2  as  in  the  obstacle  opposite-edge  case  above.  (Lemma  V-2.4).  The  rivershadow 
boundaries  will  never  intersect  the  opposite-edge  boundary,  so  it  will  consist  of  only  one  hyperbola  segment. 

3.  Road  Segments 

Single  isolated  road  segments  are  associated  with  various  types  of  boundaries,  depending  on  their 
orientation  with  respect  to  the  goal  (Theorem  V-3,  Appendix  A).  Consider  a  wedge  with  the  goal  G  as  the  ver¬ 
tex,  formed  by  extending  two  rays  from  G  through  the  line  of  the  road  intersecting  the  line  at  two  points  A  and 
B,  so  Ural  llie  interior  angles  GAB  and  GBA  are  tire  angle  yc  -  7t/2—6c,  0c  the  critical  angle  such  that  0C  = 
sin_l(R/S),  for  R  the  road  cost,  and  S  the  cross-country  cost,  where  R  is  greater  than  S.  Call  this  the  charac¬ 
teristic  wedge  of  the  road  segment.  (See  Figure  19.)  We  adopt  the  convention  for  the  following  discussion  that 
the  wedge  intersection  points  A  and  B  are  labelled  such  that  their  relative  positions  on  the  road  line  are  the 
same  as  tire  relative  positions  of  the  two  road  vertices  Vi  and  V2  (e.g,,  if  Vj  is  to  the  right  of  V2  on  a  certain 
map,  then  A  is  to  the  right  of  B).  When  A  and  B  and  V|  are  arrayed  along  the  road  line  in  the  order  B,A,Vi, 
(irrespective  of  V2’s  position),  say  that  the  characteristic  wedge  is  inside  Vi.  When  they  arc  arrayed  in  the 
order  B,V|.A  or  when  A  and  Vi  are  the  same  point,  say  that  the  wedge  straddles  V 1.  When  tlrey  are  arrayed 
in  the  order  V|,B,A,  say  that  the  wedge  is  outside  V|.  There  are  seven  types  of  boundaries  induced  by  road 
segments,  as  listed  below.  When  tire  characteristic  wedge  is  inside  Vi,  types  a,b,c,  and  d  exist  on  the  Vi  end 
of  the  road  segment.  When  tire  characteristic  wedge  straddles  Vi,  types  a  and  g  exist  on  the  Vi  end.  When  the 
characteristic  wedge  is  outside  V|.  types  a,d,  and  f  exist  on  the  V2  end,  and  vice  versa.  NVlien  tire  character!.?- 
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Figure  19 

Cimtnctciistic  Wedges 
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tic  wedge  is  inside  both  Vi  and  V2,  type  e  also  exists  on  each  end.  When  the  characteristic  wedge  is  inside  Vi 
and  straddles  V2,  type  e  exists  on  the  V)  end  only.  Figure  20  and  Figure  21  show  two  example  road  segments 
with  their  associated  boundaries  (labeled  a). 

Type  a:  Road-edge  boundaries  separate  paths  which  start  on  one  side  of  a  road  from  those  which  start 
on  !he  other  side.  All  road  segments  will  constitute  road-edge  boundaries  (Lemma  V-3.1).  For  example,  the 
road  segment  V 1 V2  in  Figure  20  is  a  road-edge  boundary. 

Type  b:  Road -end! road-travelling  boundaries  separate  paths  which  go  to  a  road  end  and  begin  using 
die  road  from  those  wliich  go  to  a  road  interior  point  and  begin  using  the  road.  They  are  linear,  and  form  a  fan¬ 
shaped  region  at  (tic  road  end.  When  the  characteristic  wedge  is  inside  a  road-end  vertex  V,  tlierc  will  be  two 
road-end/road-travelling  boundaries  beginning  at  V  and  forming  angles  of  7t/2— 0C  and  0c-7t/2with  the 
road.  (Lemma  V-3.2).  Figure  20  shows  four  such  boundaries  (labeled  b),  two  each  emanating  from  road  ver¬ 
tices  V 1  and  V2,  because  (lie  characteristic  wedge  is  inside  both  V 1  and  V2.  Figure  2 1  shows  two  road-end/road¬ 
travelling  boundaries  emanating  from  vertex  V2,  because  (lie  wedge  is  inside  V2,  but  none  from  Vi  because 
the  wedge  is  outside  Vj. 

Type  c:  Road-endlgoal  boundaries  separate  paths  wliich  travel  directly  to  the  goal  from  paths  that 
travel  to  a  road  end  and  then  along  llie  road.  Tliese  boundaries  are  segments  of  hyperbolas  where  road-end  V 
and  goal  G  are  the  foci,  and  the  hyperbola  is  described  by  Equation  1,  where  Vj=G  and  V2=V.  The  boundary 
begins  at  the  point  where  die  hyperbola  intersects  die  road-eud/road-travelling  boundary.  A  road-end/goal 
boundary  exists  on  die  goal  side  of  die  road  segment  for  vertex  V|  if  and  only  if  a  pair  of  road-end/road-travell¬ 
ing  boundaries  exist,  if  llie  characteristic  wedge  is  outside  V2,  a  road-end/goal  boundary  will  also  exist  on  the 
far  side  of  die  road  segment  for  vertex  Vi.  (Lemma  V-3.3).  In  Figure  20,  two  such  boundaries  exist  (labeled 
c),  one  associated  with  each  vertex  of  the  road  segment,  and  bodi  on  the  goal  side  of  the  road,  aldiough  die 
boundary  on  die  V2  end  is  not  shown  being  off  die  page  to  the  bottom.  In  Figure  2 1 ,  two  such  boundaries  exist 
associated  with  V2,  although  bodi  are  off  the  page. 

Type  d.  Nearside  road-travellinglgoal  boundaries  lie  on  die  near  side  of  the  road  (i.e.,  on  the  goai 
side;  and  separate  padis  which  enter  a  road  ulterior,  travel  along  it,  and  then  exn  the  road  to  cut  over  to  die 
goal  from  those  wliich  go  directly  to  the  goal.  Tliese  boundaries  are  described  by  segments  of  parabolas  defined 
lor  road-end  vertex  Vi  as  follows,  the  focus  of  die  parabola  is  the  goal.  G,  and  die  directrix  is  die  hue  perpen- 
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Road  Segment  Example  2 
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dicular  to  the  characteristic  wedge  ray  GB  and  which  intersects  the  ray  GB,  and  is  a  distance  IGAI  from  A  if 
the  characteristic  wedge  is  inside  V 1  and  not  outside  V2,  and  a  distance  IGV2I  from  V2  if  the  wedge  is  inside 
V 1  and  outside  V2.  This  parabola  is  described  by  Equation  2,  where  the  y-axis  is  the  directrix  and  the  x-axis  is 
tfie  axis  of  the  parabola. 

(Equation  2)  y2  =  4px  where  p » d  cos2(Gc)/4 

for  d  =  !GAI  if  wedge  not  outside  V2, 
and  d  =  iGV  tl  if  wedge  is  outside  V2. 


The  segment  of  die  parabola  which  is  a  boundary  begins  at  point  A  if  the  characteristic  wedge  is  in¬ 
side  V 1  and  not  outside  V2,  and  begins  at  point  V 1  if  the  characteristic  wedge  is  inside  V 1  and  outside  V2.  It 
ends  at  the  point  where  the  parabola  intersects  tire  near-side  road-end/road-travelling  boundary  and  the  road- 
end/goal  boundary  if  there  is  a  road-end  vertex,  and  continues  indefinitely  if  there  is  not.  It  exists  under  the 
same  conditions  as  these  two  exist.  (Lemma  V-3.4).  Figure  20  shows  two  near-side/road-travelling  boundaries 
(labeled  d),  because  the  wedge  is  inside  both  V 1  anu  V2.  Tire  directrices  Di  and  Dz  are  distances  !GAI  front  A 
and  1GB I  from  B  respectively,  because  the  wedge  is  inside  both  Vj  and  V2.  If  the  wedge  had  straddled  either 
vertex,  the  same  distances  would  continue  to  apply.  Figure  21  shows  one  near-sidc/road-travelling  boundary, 
but  this  one  has  a  directrix  (not  shown)  with  a  distance  IGV  tl  from  V 1  because  the  wedge  is  outside  V 1. 

Type  e:  Road-travellinglroad-crossing  boundaries  separate  paths  which  begin  on  the  far  side  of  tire 
road  from  the  goal  and  travel  along  the  road  from  those  which  also  begin  on  the  far  side  but  cross  tire  road  and 
go  directly  to  tire  goal.  This  type  of  boundary  will  exist  for  road-end  V 1  when  the  characteristic  wedge  is  in¬ 
side  V 1  and  not  outside  V2.  It  is  linear  (a  ray),  and  is  the  portion  of  the  characteristic  wedge  ray  beginning  at 
A  and  lying  on  the  far  side  of  the  road.  (Lemma  V-3.5).  Figure  20  shows  examples  of  two  road-travelling/road¬ 
crossing  boundaries  which  occur  because  the  characteristic  wedge  is  inside  both  vertices.  Figure  21  has  no  such 
boundaries,  because  the  wedge  is  outside  V2. 

Type  f:  A  far-side  road-iravellinglgoal  boundary  occurs  on  the  V 1  end  when  the  characteristic  wedge 


ic  outride  v:  It  is  a  segment  of  a  parabola  with  focus  G  and  directrix  D  such  ihai  D  is  peiptiruicuiar  to  the  ra> 


GA.  but  does  not  intersect  it  (i.e.,  D  lies  on  the  otherside  of  G  from  A),  and  D2  is  distance  IV |G!  from  Vj.  This 
parabola  is  defined  similarly  to  the  one  in  Equation  2,  except  drat  d=IV|GI.  One  far-side  road-traveiling/goal 
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boundary  occurs  in  Figure  21  on  the  V2  end  of  road  segment  because  the  characteristic  wedge  is  outside  V* 
Non  occurs  in  Figure  20,  because  the  wedge  is  outside  neither  vertex. 

Type  g:  A  road-sliadow  boundary  occurs  when  the  characteristic  edge  straddles  a  vertex  V.  It  separates 
points  whose  paths  cross  the  road  en  route  to  the  goal  from  those  which  go  directly  to  the  goal.  The  shadow 
boundary  is  a  ray  starting  at  V  and  lying  directly  away  from  G.  (Lemma  V-3.7).  Note  that  since  paths  which 
cross  roads  pay  no  additional  cost,  lliis  type  of  boundary  occurs  only  by  convention.  We  want  path  descriptions 
to  reflect  each  terrain-feaiure-edge  crossing,  even  though  no  change  in  direction  or  cost  rate  occurs  for  this 
case.  This  type  is  not  illustrated  in  the  accompanying  figures. 

4,  Homogeneous-Cost  Areas  (HCA) 

Homogeneous-cost  areas  (HCA)  generate  boundaries  both  inside  and  outside  the  HCA.  The  outside 
boundaries  are  similar,  although  not  identical,  to  those  associated  with  obstacles,  rivers,  and  roads.  This  is  not 
surprising,  since  the  HCA  is  a  generalization  of  each  of  these  types  of  terrain.  There  are  four  cases,  based  on 
the  relative  costs  of  the  HCA  interior  and  exterior  and  the  location  of  the  goal  inside  or  outside  the  HCA.  We 
first  consider  the  case  where  the  cost  of  the  interior  of  the  HCA  is  greater  than  the  cost  of  the  exterior  and  the 
goal  point  lies  outside  the  HCA,  then  the  high-cost,  interior-goal  case,  the  low-cost  exterior-goal  case,  and  the 
low-cost  interior-goal  case. 

a.  High-Cost  HCA  With  An  Exterior  Goal 

When  the  goal  is  exterior  to  the  homogeneous-cost  area,  and  the  cost  of  the  HCA  is  greater  titan 
the  surrounding  terrain,  boundaries  occur  according  to  Theorem  V-4,  Appendix  A.  Define  a  visible  edge  of  an 
HCA  to  be  an  HCA  edge  for  which  no  point  on  the  edge  has  an  optimal-path  list  whose  first  element  lies  on 
the  HCA  perimeter.  Define  a  hidden  edge  as  a  non-visible  edge,  i.e.,  an  edge  for  which  some  point  on  tlie  edge 
has  an  optimal-path  list  whose  first  element  lies  on  the  HCA  perimeter.  Thus  a  hidden  edge  may  have  points 
whose  optimal  paths  travel  through  the  HCA,  which  would  mean  that  their  optimal  paths  would  have  as  their 
first  element  tlie  visible  edge  across  which  they  pass.  Define  opposite-edge  sequence  as  the  smallest  connected 
sequence  of  hidden  edges  for  which  the  first  and  last  endpoints  of  the  edge  sequence  have  optimal  paths  whose 
initial  directions  follow  the  HCA  edges  in  opposite  (i.e.,  clockwise  versus  counterclockwise)  directions.  If  no 
such  endpoint  can  be  found  at  one  end  or  the  other  of  the  sequence  of  hidden  edges,  let  tlie  endpoint  at  that  end 
be  the  "outer"  vertex  of  the  last  hidden  edge.  i.e..  the  vertex  wliich  joins  the  last  hidden  edge  in  the  clockwise 
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(or  counterclockwise)  direction  with  the  first  visible  edge  in  the  clockwise  (or  counterclockwise)  direction.  In 
Figure  22,  the  initial  direction  of  optimal  paths  for  each  edge  endpoint  is  shown  as  a  vector.  HCA  1  has  op¬ 
posite-edge  sequence  ED,  HCA  2  has  opposite-edge  sequence  EDCB,  HCA  3  has  opposite-edge  sequence 
FED,  and  HCA  4  has  opposite-edge  sequence  JIHFE.  Essentially,  this  definition  specifies  the  range  over  wliich 
a  search  must  be  conducted  for  an  opposite  point,  if  one  exists,  and  defines  the  HCA  vertices  which  may 
generate  opposite-edge  boundaries  (see  below).  Define  the  opposite  point  of  an  HCA  as  a  point  with  two  op¬ 
timal  paths  lying  in  opposite  directions  (i.e.,  clockwise  and  counterclockwise)  along  HCA  edges.  If  "shortcut- 
ting"  occurs  through  the  center  of  HCA,  the  opposite  point  might  not  exist,  as  in  HCA  2  and  HCA  3  of  Figure 
22. 

Define  the  critical  angle  0c  of  an  HCA  as  sin‘'(ci/c2)  where  the  Ci  are  the  unit  costs  inside  and 
outside  the  HCA,  and  ci  >  C2.  An  optimal  path  crossing  an  HCA  edge  will  obey  an  analogue  of  Sneii’s  Law 
in  optics  [Ref.  20]  (see  Chapter  II,  Section  E)  so  that  for  angle  of  incidence  0i  and  angle  of  refraction  02, 
and  cost  rates  ci  and  C2  on  either  side  of  the  edge,  cj  sin(0i)=  C2Sin(02).  (See  also  Chapter  II,  Section 
E2b(3)  and  Figure  II-8). 

Inside  a  high-cost  HCA  with  external  goal,  there  are  four  types  of  boundaries  (See  Figures  23, 
24,  and  25).  Each  pair  of  HCA  edges  is  potentially  associated  with  an  interior  boundary.  The  boundary  type 
depends  on  whether  the  edges  are  visible  or  hidden,  and  are  on  the  same  or  opposite  sides  of  the  opposite-edge 
boundary.  A  visible-edge  boundary  distinguishes  optimal  paths  which  go  through  two  different  visible  edges; 
the  optimal  paths  cross  their  respective  edges  according  to  Snell’s  Law.  Lemma  V-4.1  (Appendix  A)  states 
the  analytic  form  of  such  a  boundary.  Although  not  expressible  in  closed  form,  the  boundary  has  much  the 
same  shape  as  a  hyperbola  segment  wliich  forms  an  obstacle  opposite-edge  boundary,  i.e,  it  has  positive  but 
decreasing  curvature  from  its  point  of  incidence  upon  an  HCA  vertex  inward  into  the  HCA,  and  this  curva¬ 
ture  is  typically  small  so  that  the  curve  is  almost  linear.  An  example  of  a  visible-edge  boundary  is  found  in 
Figure  23,  labeled  a. 

A  visible-hidden-cdge  boundary  distinguishes  optimal  paths  going  through  a  visible  edge  from 
those  going  through  a  hidden  edge;  the  latter  paths  traverse  the  HCA  edge  at  exactly  the  critical  angle  and  the 
follow  the  edge.  Lemma  V-4.2  states  the  analytic  form  of  tliis  type  of  boundary,  which  again  is  similar  to  a 
hyperbola.  Examples  of  litis  type  of  boundary  occur  in  Figures  23, 24,  and  25  and  are  labeled  b. 
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A  hidden-edge  merging-path  boundary  distinguishes  optimal  paths  leaving  the  HCA  at  two  dif¬ 
ferent  hidden  edges  at  exactly  the  critical  angle,  and  for  which  all  paths  merge  before  the  goal.  A  way  to  check 
for  this  behavior  is  to  sec  if  as  optimal  path  from  a  vertex  of  one  of  the  edges  includes  a  vertex  of  the  other 
edge-.  Lemma  V-4.3  states  the  analytic  form  of  this  type  of  boundary,  which  is  a  line  segment.  The  boundaries 
labeled  c  in  Figures  23, 24,  and  25  are  hidden-edge  merging-path  boundaries.  A  hidden-edge  diverging-patit 
boundary  is  like  the  preceding  except  the  two  classes  of  paths  merge  only  at  the  goal.  This  type  of  boundary 
is  also  a  line  segment,  as  stated  in  Lemma  V-4.4.  Examples  of  this  type  of  boundary  occur  in  Figures  24  and 
25  and  are  labeled  d. 

Each  pair  of  adjacent  edges  is  always  associated  with  one  of  the  above  interior  boundaries,  while 
non-adjacent  edges  may  or  may  not  be.  If  short  cutting  does  not  occur  across  an  HCA  comer,  a  boundary  will 
start  at  the  vertex  at  that  comer.  If  shortcutting  does  occur,  the  boundary  associated  with  that  vertex  will  in¬ 
tersect  the  HCA  edge  at  the  point  where  short  cutting  starts  (see  figure  23  where  two  of  the  boundaries  labeled 
b  intersect  the  opposite  edge,  Figure  24  where  one  of  the  boundaries  labeled  b  intersects  the  lower  right  edge 
of  the  HCA,  and  Lemma  V-4.5).  From  the  vertex  or  shortcutting  point  at  which  such  a  boundary  begins,  it  will 
continue  into  the  HCA  interior  until  it  intersects  another  boundary  or  HCA  edge.  At  the  point  at  which  two 
such  boundaries  first  intersect  they  will  terminate,  and  a  third  boundary  will  begin  which  represents  the  division 
'  «?.en  the  two  regions  which  the  first  two  bound arias  did  net  have  in  common.  For  example,  in  figure  23 
the  boundary  associated  with  vertex  Vi  distinguishes  paths  which  cross  edge  V1V2  from  those  which  travel 
along  edge  V 1 V5,  while  the  boundary  associated  with  vertex  V5  distinguishes  those  which  travel  along  edge 
VjVj  from  those  wliich  travel  along  edge  V4V5  passing  tiirough  vertex  V5.  These  two  boundaries  begin  at 
their  respective  vertices  and  intersect  in  lire  HCA  interior,  and  from  that  point  a  third  boundary  begins  which 
distinguishes  paths  which  cross  edge  V 1 V2  from  those  which  travel  along  edge  V4V5  passing  through  vertex 
V5.  These  two  descriptions  (’’crossing  V1V2”  and  "travelling  along  V4V5  through  V5")  represent  the  two 
regions  which  tire  initial  boundaries  did  not  have  in  common,  so  they  characterize  tfic  tiiird  boundary.  Boun¬ 
daries  will  continue  to  intersect  and  new  ones  begin  in  the  HCA  interior  until  tire  boundary  associated  with 
each  visible  vertex  is  joined  with  one  ormorc  hidden  vertices  or  HCA  edges  (Lemmas  V-4.10  and  V-4.1 1). 

These  networks  of  boundaries  can  be  represented  as  trees,  where  each  boundary  is  considered  a  node,  and 
edges  connect  nodes  whose  boutKlarics  intersect  (see  Lemma  V-4.10).  Such  a  tree,  called  an  interior-bound- 
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ary  tree,  lias  interior  nodes  with  exactly  two  children ,  while  the  root  of  such  a  tree  can  have  zero,  two,  or  four 
children.  A  tree  whose  root  and  sole  node  has  zero  cltiidren  represents  a  boundary  which  goes  from  one  edge 
of  ibe  HCA  to  anotlier  without  intersecting  any  other  boundaries,  such  a*  sue  boundary  cmaret'ine  from  ver¬ 
tex  V2  in  Figure  23.  A  boundary  separates  two  regions,  and  ray  time  two  boundaries  intersect  it  must  be,  as 
explained  above,  that  they  have  one  of  the  two  regions  in  common.  Beyond  the  point  of  intersection,  the  two 
regions  tltey  did  not  have  in  common  mus'  be  separated  by  a  boundary.  Thus  each  time  two  boundaries  inter¬ 
sect,  a  third  must  begin.  We  choose  as  leaf  nodes  those  boundaries  associated  with  HCA  vertices,  because  one 
of  tliese  boundaries  is  guaranteed  to  exist  for  each  vertex,  and  no  other  interior  boundaries  intersect  it  at  tlie 
vertex  or  edge,  so  we  can  be  sure  that  Urey  will  have  no  children.  At  Ute  other  end  of  such  a  boundary  it  eitlier 
intersects  an  HCA  edge,  meaning  its  node  is  a  root  without  children  as  described  above,  or  it  intersects  two 
other  boundaries,  one  of  which  will  also  be  associated  with  an  HCA  vertex  and  so  be  another  leaf  node.  If  the 
latter  is  true,  the  boundary  beginoning  at  the  intersection  point  of  the  two  leaf-  node  boundaries  will  serve  as 
the  parent  node  of  the  two  boundaries.  This  merging  of  boundaries  will  continue  until  the  parent  node’s  bound¬ 
ary  intersects  an  HCA  edge,  in  which  case  the  node  is  the  tree’s  root,  or  until  roots  of  two  boundary  trees  are 
found  to  represent  the  same  boundary,  in  which  case  the  two  trees  can  be  merged  into  one.  This  is  the  case 
wlrere  a  root  will  have  four  children,  representing  the  two  boundaries  which  intersect  each  end  of  the  root’s 
boundary.  Several  examples  and  illustrations  of  the  construction  of  such  interior-boundary  trees  are  given  in 
Chapter  VI. 

Outside  the  HCA,  there  are  four  types  of  boundaries  Again,  HCA  edges  ate  trivial  boundaries 
(Lemma  V-4.5).  //CA  shadows  arc  defined  exactly  as  forobstacles  (Lentma  V-4.6).  Examples  of  HCA  shadow 
boundaries  are  labeled  e  in  Figures  23, 24,  and  25.  The  other  two  types  are  HCA  opposite-edge  boundaries 
and  HCA  corner-cutting  boundaries.  HCA  opposite-edge  boundaries  are  the  generalization  of  obstacle  op¬ 
posite-edge  boundaries,  and  differentiate  between  paths  which  start  outside  the  HCA  and  go  through  or  around 
tire  HCA  in  different  directions.  There  are  three  types  of  opposite-edge  boundaries,  depending  on  whether 
ncitlrcr,  one,  or  both  optimal  paths  go  through  an  HCA  edge.  A  path  which  does  not  go  through  tltc  HCA  goes 
around  it  initially  via  one  of  its  vertices.  The  case  wire  re  neither  path  goes  through  the  HCA  is  die  same  as  tltc 
obstacle  opposite-edge  boundary  case,  and  is  described  by  connected  hyperbola  segments.  Tltc  first  and  second 
cases  have  more  complicated  analytic  forms,  although  the  shape  of  tltc  boundaries  is  very  similar  to  hyper- 
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bolas.  (Lemma  V-4.7).  In  Figures  23, 24,  and  25,  opposite-edge  boundaries  are  labeled  f.  In  Figures  23  and 
24  all  three  cases  occur,  while  in  Figure  25  lire  HCA  is  a  virtual  obstacle,  that  is,  it  appears  to  points  outside 
it  that  it  is  an  obstacle,  so  the  only  opposite-edge  boundary  it  has  is  the  third,  or  hyperbolic  case. 

HCA  Comer-cutting  boundaries  occur  when  optimal  paths  cut  into  the  HCA  along  an  edge  which 
is  not  part  of  the  opposite-edge  sequence.  In  fact,  the  analytic  form  of  this  boundary  is  just  a  variation  of  the 
second  of  the  three  types  of  opposite-edge  boundaries  discussed  in  the  previous  paragraph.  Comer-cutting 
boundaries  emanate  from  a  vertex  connecting  a  hidden  and  a  visible  edge  when  shortcutting  occurs  across 
those  edges  (for  example,  in  Figure  24,  labeled  g).  In  the  generalization  of  this  case  where  the  edges  across 
which  shortcutting  occurs  are  separated  by  one  or  more  edges,  the  comer-cutting  boundary  begins  at  die  point 
at  which  tl»e  set  of  interior  boundaries  intersects  tlie  hidden  ec'.te  (Lemma  V-4.8). 

The  construction  of  interior-boundary  trees  is  useful  in  finding  exterior  boundaries.  There  is  ex¬ 
actly  one  opposite-edge  or  comer-cutting  boundary  associated  with  each  interior  tree  of  boundaries,  and  each 
visible  HCA  vertex  is  connected,  either  directly  or  via  its  interior  boundary  tree,  to  an  opposite-edge  or  coroer- 
cutling  boundary.  (Lemma  V-4. 11).  When  an  interior  boundary  tree  includes  as  a  leaf  node  an  interior  hidden- 
edge-diverging-path  boundary,  the  point  at  which  the  boundary  intersects  the  HCA  edge  is  connected  with  an 
exterior  opposite-edge  boundary.  When  an  interior-boundary  tree  includes  as  a  leaf  node  a  point  of  intersec¬ 
tion  of  an  interior  boundary  and  an  HCA  edge,  but  does  not  include  an  opposite  point,  for  example,  as  hap¬ 
pens  three  times  along  the  hidden  edge  of  the  HCA  in  figure  23,  this  point  of  intersection  is  connected  with 
an  exterior  opposite-edge  or  comer-cutting  boundary.  When  as  happens  to  the  rightmost  vertex  in  figure  24, 
a  vertex  is  not  connected  with  any  interior  boundary  tree,  comersbort  cutting  occurs  and  a  corner-cutting  bound¬ 
ary  is  connected  with  tire  comer  vertex.  Two  HCA  opposite-edge  boundaries  or  comer-cutting  boundaries  may 
intersect  each  otlrer  or  a  shadow  boundary,  and  if  they  do  a  third  boundary  begins  at  the  point  of  intersection 
and  lies  away  from  the  goal,  as  in  the  case  of  obstacle  opposite-edges. 

An  optimal  path  will  travel  into  a  high-cost  HCA  from  outside  it  only  across  an  edge  which  forms 
an  angle  greater  than  sin'*(20c)  with  another  connected  HCA  edge  (Ref.  20],  If  none  of  the  hidden  edges  are 
associated  with  included  angles  of  less  than  20c  wifi;  ^iinccted  visible  edges  and  the  cost  ratio  and  dimen¬ 
sions  of  the  HCA  allow,  it  acts  exactly  as  an  obstacle  with  respect  to  all  start-points  outside  the  HCA.  Such  an 
HCA  is  called  a  virtual  obstacle.  Tlie  HCA  shown  in  Figure  25  is  a  virtual  obstacle.  If  all  tire  opposite-edge 
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and  comer-cutting  boundaries  converge  and  become  a  single  opposite-edge  boundary  away  from  the  goal,  tbe 
HCA  becomes,  for  all  points  beyond  the  point  of  convergence,  a  virtual  obstacle, 
b.  High-Cost  HCA  With  An  Interior  Goal 

An  HCA  containing  the  goal  point  and  with  higher  cost  than  tbe  surrounding  terrain  generates  a 
set  of  exterior  boundaries  similar  to  the  high-cost  exterior-goal  case,  while  the  interior  boundaries  are  reminis¬ 
cent  of  road  boundaries.  The  similarity  to  road  boundaries  arises  because  for  start-points  inside  the  HCA,  it 
may  be  profitable  to  move  away  from  the  goal  point  initially  in  order  to  travel  along  an  HCA  edge  in  the  ex¬ 
terior,  lower-cost  region,  just  as  if  there  were  a  road  segment  along  the  HCA  edge,  figure  26  illustrates  the 
high-cost  interior-goal  case  (see  Theorem  V-5). 

We  will  define  edges  for  tlvis  case  with  respect  to  each  of  its  vertices,  so  that  an  edge  may  be 
defined  differently  for  each  of  its  endpoints.  Define  a  visible  edge  with  respect  to  one  of  its  vertices  V  as  an 
edge  for  which  the  optimal  path  from  V  cuts  into  tlie  HCA  interior  at  some  point  along  tbe  edge  (either  im¬ 
mediately  from  V  or  along  tbe  edge  interior).  Define  a  hidden  edge  with  respect  to  V  as  an  edge  for  which  the 
optimal  path  from  V  starts  along  the  other  edge  incident  to  V,  or  fot  which  no  optimal  path  from  any  point  on 
the  edge  cuts  directly  into  the  HCA  interior.  Define  an  opposite  edge  as  an  edge  which  is  a  hidden  edge  with 
respect  to  both  its  vertices.  There  are  four  types  of  interior  boundaries,  winch  are  line  segments  and  parabola 
segments.  Each  HCA  vertex  can  generate  a  set  of  boundaries.  For  each  vertex  V,  if  the  optimal-path  from  that 
vertex  consists  only  of  the  goal  point,  i.c,  if  the  optimal  path  from  tbe  vertex  goes  directly  to  the  goal,  then 
there  are  no  interior  boundaries  associated  with  that  vertex. 

If  on  tlte  oilier  liand  the  optimal  path  from  HCA  vertex  V  travels  initially  along  ar:  HCA  edge, 
call  the  edge  along  which  the  path  travels  initially  E2,  and  call  the  other  HCA  edge  incident  upon  V  (along 
which  tlie  patli  docs  not  travel)  E|.  In  this  case  there  will  be  a  boundary  associated  with  vertex  V  which  is  a 
line  segment.  This  boundary  starts  at  V  and  separates  paths  which  cut  over  to  edge  Ei  and  go  through  V  from 
those  wliich  cut  over  to  edge  E2,  bypassing  V.  This  is  a  hidden-edge  boundary  as  defined  for  the  exterior-goal 
case  above.  (In  Figure  26,  boundaries  labelled  a  are  hidden-edge  boundaries.  Also  see  Lemma  V-5.I  in  Ap¬ 
pendix  A).  In  this  case  there  will  also  be  a  parabolic  boundary  called  a  hidden-edge! goal  boundary,  which 
separates  optima?  paths  which  go  directly  to  the  goal  from  those  wliich  go  initially  away  from  lire  goal  to  edge 
Ei  and  from  tlierc  through  V  and  on  around  tlie  HCA,  cutting  back  in  to  the  goal  at  another  point  on  tlie  HCA 
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perimeter.  Tliis  parabola  is  formed  by  considering  the  goal  point  as  the  focus,  and  constructing  the  directrix 
such  that  it  is  perpendicular  to  a  line  from  V  into  the  HCA  exterior  which  forms  an  angle  of  71/2  +  0C  with 
edge  Ei ,  and  such  that  it  is  a  distance  d  from  V  wlterc  d  =  cost(optimal  path  from  V)/c  i ,  where  c  i  =  exterior 
cost.  (See  the  boundaries  in  Figure  26  labeled  b,  and  Lemma  V-5.2,  Appendix  A.) 

If  in  addition,  the  first  turn  point  P  on  tlte  optimal  path  from  V  is  an  interior  point  of  edge  E2, 
i.e.,  if  the  second  leg  of  tlte  optimal  path  from  V  cuts  into  the  HCA  to  the  goal,  there  will  be  a  boundary  called 
a  visible-edge! goal  boundary  associated  with  V  and  edge  E2  which  separates  paths  that  go  directly  to  the  goal 
from  those  wliich  go  initially  back  to  E2  then  travel  along  E2  to  P,  and  then  cut  into  the  HCA  at  P  to  the  goal. 
The  visible-edge/goal  boundary  intersects  the  HCA  edge  at  P.  Again,  the  focus  is  the  goal  point,  and  in  this 
case  the  directrix  is  perpendicular  to  a  line  from  P  into  tlte  HCA  exterior  which  forms  an  angle  with  line  seg¬ 
ment  P V  of  7t/2  +  0c,  and  which  is  distance  d  from  P  such  that  d  =  cost(OPL(P))/c  i .  (See  Figure  26,  the  boun¬ 
daries  labeled  c,  and  Lemma  V-5.3.) 

The  other  type  of  interior  boundary  occurs  when  two  adjacent  vertices  on  a  hidden  edge  have 
optimal  paths  which  both  lie  initially  on  an  HCA  edge,  but  which  go  in  opposite  directions  around  the  HCA 
(i.e.,  for  which  neither  optimal  path  includes  the  other  vertex).  This  is  the  same  situation  that  occurs  in  the 
definition  of  an  obstacle  opposite-edge,  and  so  such  an  edge  is  called  an  HCA  opposite  edge.  However,  there 
may  be  zero,  one,  or  more  opposite  edges  in  this  case.  Each  HCA  opposite  edge  V 1 V2  generates  an  interior 
opposite-edge  boundary,  which  separates  paths  which  exit  the  HCA  and  go  through  vertex  Vi  from  those 
which  exit  and  go  through  vertex  V2 .  (See  Figure  26,  the  boundary  labeled  c,  and  Lemma  V-5.4.) 

The  exterior  boundaries  in  tills  case  are  quite  similar  to  the  high-cost  exterior-goal  HCA  case. 
Tlierc  arc  five  types  of  exterior  boundaries.  HCA  edges  are  trivial  boundaries  (Lemma  V-5.5).  Shadow  boun¬ 
daries  are  associated  with  each  vertex  V  whose  optimal  path  OPL(V)  includes  as  its  first  path-vertex  a  point 
P  on  the  HCA  perimeter.  The  shadow  boundary  is  constructed  by  extending  a  ray  from  V  along  line  VP  away 
from  P.  (See  Figure  26,  boundaries  labeled  e,  and  Lemma  V-5.6.) 

Opposite-edge  boundaries  emanate  from  each  HCA  opposite  edge.  An  opposite-edge  boundary 
begins  at  an  opposite  point  with  a  hyperbola  segment  and  extends  outward  from  the  HCA,  being  formed  ex¬ 
actly  as  in  the  exterior-goal  case.  Since  there  may  be  more  than  one  opposite  edge,  there  may  also  be  more 
than  one  opposite-edge  boundary.  (See  Figure  26.  boundaries  labeled  f  and  Lemma  V-5.7.)  Visible-edge  boun- 
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claries  separate  paths  which  cross  two  edges  en  route  to  the  goal.  This  type  of  boundary  exists  whenever  an 
optimal  path  from  an  HCA  vertex  goes  directly  to  the  goal.  The  boundary  starts  at  the  vertex  and  lies  outward, 
possibly  terminating  wlien  it  intersects  the  next  kind  of  boundary.  (See  boundary  labeled  g  in  Figure  26,  and 
Lemma  V-5.8.)  Corner-cutting  boundaries  emanate  from  points  at  which  hidden-edge/goal  boundaries  from 
the  interior  intersect  tire  HCA  edge.  They  separate  points  whose  optimal  paths  cross  the  edge  from  those  which 
go  around  the  edge  vertex.  These  boundaries  begin  at  the  HCA  edge  and  are  concatenated  with  new  curve  seg¬ 
ments  at  each  point  at  which  the  earliercurve  intersects  a  shadow  boundary,  as  in  the  comer-cutting  case  above. 
(See  boundaries  labeled  h  in  Figure  26,  and  Lemma  V-5.9.) 
c.  Low-Cost  HCA  With  An  Interior  Goal 

Analysis  of  an  HCA  with  lower  cost  than  the  surrounding  terrain,  where  the  goal  is  in  the  HCA 
interior,  shows  a  much  simpler  set  of  boundaries  (Theorem  V-6).  There  will  never  be  any  boundaries  inside 
the  HCA  in  this  case,  because  there  is  no  incentive  for  an  optimal  path  to  move  away  from  the  goal  to  the  high- 
cost,  external  terrain,  and  there  are  no  terrain-feature  edges  or  vertices  between  any  point  in  the  HCA  and  the 
goal,  since  our  HCA’s  are  assumed  convex.  (See  Lemma  V-6.1,  Appendix  A.)  External  boundaries  will  occur 
in  pairs,  forming  a  wedge  emanating  from  each  vertex  of  the  HCA,  much  as  in  the  case  of  road-end/road  travell¬ 
ing  boundaries  for  a  road  segment.  The  external  boundaries  are  all  rays  which  begin  at  an  HCA  venex  and  L. 
away  from  the  goal,  and  can  be  constructed  by  tracing  a  path  from  the  goal  to  the  vertex,  and  then  employing 
Snell’s  Law  for  the  path  with  respect  to  each  of  the  edges  incident  to  the  vertex  to  determine  the  orientation 
of  the  two  boundaries.  Call  this  type  of  boundary  a  vertexledge-crossing  boundary  (see  Lemma  V-6.2).  Figure 
27  shows  a  low-cost  HCA  with  interior  goal,  and  the  boundaries  it  induces  on  the  plane. 
r*..  Low-Cost  HCA  With  An  Exterior  Goal 

Tlie  final  case,  where  tlie  cost  inside  the  HCA  is  lower  than  the  surrounding  terrain  and  tlie  goal 
is  outside  the  HCA,  bears  some  similarities  to  the  low-cost,  interior-goal  case  and  some  to  tlie  high-cost,  inte¬ 
rior-goal  case.  In  this  case,  parabolic  and  similar  boundaries  occur  outside  the  HCA,  treating  HCA  edges  as 
if  they  were  roads,  and  the  wedges  wliich  occur  in  the  low-cost,  interior-goal  case  are  present  in  this  case  as 
well.  Only  one  type  of  boundary1  occurs  in  lire  HCA  interior,  and  seven  types  occur  in  the  HCA  exterior 
(Theorem  V-7).  Figure  28  illustrates  a  typical  low-cost,  exterior-goal  HCA. 
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Figure  27 

Low-Cost,  Interior-Goal  HCA 
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In  tiie  exterior,  in  addition  to  the  trivial  edge-  boundaries  (Lemma  V-7.1),  boundaries  can  be  con¬ 
structed  by  considering  the  behavior  of  the  optimal  path  from  each  of  the  HCA  vertices.  For  each  vertex  V  of 
the  HCA,  let  E|  and  E2  be  the  edges  incident  upon  V,  while  Vi  and  V2  are  the  vertices  such  that  Wj  *  E| 
and  W2  =  E2 .  Additionally,  let  vertex  Vj  be  closer  to  the  goal  than  vertex  V2,  i.e.,  the  cost  of  the  optimal 
path  from  Vi  be  less  than  the  cost  of  the  optimal  path  from  V2. 

If  die  optimal  path  ^om  V  goes  initially  along  HCA  edge  E],  (note  that  it  will  not  go  along  E2 
because  of  the  naming  convention  above),  the  paths  treat  the  edge  somewhat  as  if  it  were  a  road.  Let  P  be  the 
first  point  on  tlx:  optimal  path  from  V,  which  will  be  the  point  at  which  the  path  exits  the  HCA  interior  toward 
the  goal.  A  vertex! edge-following  boundary  and  a  vertex/edge-crossing  boundary  are  associated  with  from  V 
with  respect  to  edges  E|  and  E2  respectively.  n»e  vertex/edge-crossing  boundary  is  a  ray  with  vertex  V  lying 
in  die  HCA  exterior  such  that  the  ray  and  the  first  leg  of  the  optimal  path  from  V  form  a  Snell’s-Law  crossing 
of  HCA  edge  E2  (see  Lemma  V-7.2).  This  type  of  boundary  separates  paths  which  go  to  vertex  V  and  then 
along  edge  Ei  from  those  that  go  directly  to  Ei  and  fcliow  along  it.  The  vertex/edge-following  boundary  is  a 
special  case  of  the  vertex/edgc-crossing  boundary  where  the  Snell’s-Law  angle  of  the  ray  with  edge  Ei  is  the 
critical  angle  0C  (sec  Lemma  V-7.3).  These  boundaries  are  labeled  1  in  Figure  28.  The  vertex/edge-crossing 
boundary  separates  pallis  which  go  to  a  vertex  V  and  then  cut  into  the  HCA  interior  from  those  that  cross  edge 
Ej  into  die  interior.  In  Figure  28,  these  boundaries  are  labeled  2. 

Also  occurring  is  an  edge-followinglgoal  boundary  which  is  a  parabola  with  the  goal  point  as 
focus  and  directrix  perpendicular  to  a  line  from  P  at  an  angle  7C/2  +  0C,  lying  a  distanced  away  from  P  where 
d  is  (lie  cost  of  an  optimal  path  from  P.  This  type  of  boundary  separates  paths  which  go  to  edge  Ei  and  follow 
Uk  edge  from  those  which  go  directly  to  tire  goal.  (See  Lemma  V-7.4)  Figure  28  has  these  type  of  boundaries 
labeled  4.  Additionally,  a  vertexlgoal  boundary  occurs  which  is  similar  to  tire  road-end/goal  boundary  of  tlic 
road  segment  case.  This  boundary  begins  at  the  point  at  which  the  edge-followtng/goal  boundary  intersects 
the  vertex/edge-following  boundary,  and  is  a  hyperbola  segment  with  V  and  G  being  the  foci,  and  the  hyper¬ 
bolic  constant  being  the  cost  of  tire  optimal  path  front  V  (see  Lemma  V-7.5).  Figure  28  labels  this  type  of 
boundary  3.  Tliis  boundary  may  continue  indefinitely,  or  it  may  intersect  the  vertex/edge-crossing  boundary 
emanating  from  V.  If  these  two  intersect,  both  terminate  at  the  point  of  intersection  and  a  third  boundary  dis¬ 
cussed  below  begias. 
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Key  to  Bdry  Types: 

1  -  vertex/edge-following  (line) 

2  -  vertex/edge-crossing  (line) 

3  -  vertex/goal  (hyperbola) 

4  -  edge-following/goal  (parabola) 

5  -  edge-crossing/goal 

(distorted  hyperbola) 

6  -  visible-edge  (distorted 

hyperbola) 

7  —  opposite— edge  (distorted 

hyperbola) 


5oal 


KEY: 


Homogeneous- 
Cost  Area 


Boundary 

Initial 
direction  of 
optimal  path 

Goal 


Figure  28 

Low-Cost,  Exterior-Goal  HCA 
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For  each  HCA  vertex  V  for  which  the  optimal  path  from  V  goes  initially  into  U»e  RCA  interior, 
a  pair  of  linear  vertex/edge-crossing  boundaries  will  occur,  just  as  in  the  interior-goal,  low-cost  case.  These 
boundaries  separate  points  whose  optimal  patlts  enter  the  HCA  through  a  hidden  vertex  from  those  which  enter 
through  a  hidden  edge.  Each  boundary  is  constructed  by  extending  a  ray  from  V  into  the  HCA  exterior  such 
that  the  ray  and  tlie  first  leg  of  the  optimal  path  from  V  fonn  a  Snell’s-Law  crossing  of  Et  and  E2  respective¬ 
ly.  If  in  addition  the  vertex/goal  boundary  associated  with  vertex  V 1  intersects  the  vertex/edge-crossing  bound¬ 
ary  emanating  from  V 1  associated  with  edge  Ei,  a  third  boundary  begins.  If  the  first  point  P  along  tire  optimal 
path  from  V  is  an  HCA  vertex,  the  boundary  will  be  an  edge-following/goal  boundary,  a  parabola,  as  discussed 
above.  If  P  is  an  inierior  point  of  an  HCA  edge,  the  boundary  will  a  more  general  type  of  curve  similar  in  shape 
to  a  parabola,  called  an  cdge-crossinglgoal  boundary  (see  Lemma  V-7.6)  In  Figure  28,  these  type  of  boun¬ 
daries  are  labeled  5.  A  vertex/goal  boundary  also  occurs,  beginning  at  the  point  at  which  the  edge-crossing/goal 
boundary  intersects  the  vertex/edge-crossing  (or  edge-following)  boundary  associated  with  edge  E|  . 
Whenever  an  interior  boundary  (see  below)  intersects  a  hidden  edge  of  the  HCA,  an  exterior  boundary  begins, 
called  an  opposite-edge  boundary  (see  Lemma  V-7.8  and  Figure  28  boundary  labeled  7).  Opposite-edge  boun¬ 
daries  separate  paths  which  cross  an  edge  into  the  HCA  Ulterior  and  then  go  across  the  HCA  to  exit  across  a 
second,  visible  edge,  from  those  which  cross  the  same  first  edge  into  the  HCA  but  exit  across  a  third,  visible 
edge.  Just  as  in  the  high-cost,  exterior-goal  case,  these  boundaries  may  intersect  and  new  opposite-edge  boun¬ 
daries  begin,  but  in  this  case  they  arc  of  only  one  type  and  separate  paths  which  cross  one  pair  of  edges  from 
those  which  cross  another  pair. 

There  is  only  one  type  of  boundary  in  lire  interior  of  a  low-cost,  exterior-goal  HCA.  It  begins  at 
a  visible  vertex  wliich  is  not  directly  connected  to  any  other  boundaries,  and  separates  points  whose  optimal 
pathi.  cross  one  visible  edge  incident  to  lire  vertex  from  those  which  cross  the  other  visible  edge.  Because  of 
its  similar  boundary  type  in  the  high-cost  exterior-goal  case,  it  is  called  a  visible-edge  boundary  (see  Lemma 
V-7.7  and  the  boundary  labeled  6  in  Figure  28).  Just  as  in  that  case,  the  interior  boundaries  may  intersect  and 
generate  new  boundaries,  which  are  alsv.  isiblc-cdgc  boundaries.  Whenever  a  visible-edge  boundary  inter¬ 
sects  a  lu'ddcn  edge,  die  visible-edge  boundary  lenuinates  and  an  opposite-edge  boundary  begins  in  the  HCA 
exterior.  Both  the  visible-edge  boundary  and  lire  opposite-edge  boundary  types  are  similar  in  shape  to  hyper- 
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bola  segments,  although  their  algebraic  form  is  not  expressible  in  closed  form.  These  boundaries  typically 
have  very  little  curvature. 

B.  A  UNIFYING  VIEW  OF  REGION  BOUNDARIES 

Hie  boundaries  associated  with  each  terrain  feature  and  tire  homogeneous-behavior  regions  they  separate 
can  be  viewed  in  a  more  unified  manner.  This  view  will  provide  the  basis  for  a  key  step  in  the  algorithm 
presented  in  Chapter  VI  which  merges  optimal-path  maps  for  isolated  terrain  features  into  consolidated  op¬ 
timal-path  maps. 

1.  Cost  Functions  of  Regions  With  Respect  to  Region  Roots 

Tiie  cost  of  optimal  paths  from  each  start  point  in  tiie  plane  is  a  function  of  the  location  of  the  start 
point.  In  other  words,  there  is  a  cost  function  of  X  and  Y  which  characterizes  the  entire  map.  Consider  tire 
region  in  die  vicinity  of  the  goal,  for  which  tire  goal  is  tire  region  root.  Cost  is  proportioual  to  distance  from 
tire  goal,  in  tire  absence  of  intervening  terrain,  so  iso-cost  contours  form  circles  about  tire  goal.  This  cost  func¬ 
tion  is  an  inverted  cone  with  vertex  at  the  goal-point,  or  the  upperhalf  of  a  cone  as  defined  in  classical  geometry. 
In  any  homogeneous-behavior  region  with  a  point  as  its  root,  there  will  be  some  additional  cost  of  tire  optimal 
path  from  the  root  to  the  goal.  For  each  region  whose  root  is  a  single  point  then,  the  cost  function  in  the  region 
will  be  conical  with  respect  to  a  vertical  axis  through  the  point.  The  vertex  of  the  cone  representing  the  cost 
function  will  be  sliified  upward  on  the  cost  axis  by  the  amount  of  the  cost  of  an  optimal  path  from  the  root. 

Another  type  of  region  root  is  an  edge  along  which  paths  travel  en  route  to  the  goal,  for  example,  a 
road  segment  (see  Figure  29).  In  the  discussion  above  regarding  road  segments,  it  was  noted  that  the  path  from 
a  point  whose  optimal  path  enters  a  road  to  travel  along  it  does  so  at  tiie  critical  angle  0C  =  siif'(Q/Cb). 
where  Cr  is  die  cost  of  travelling  a  unit  distance  by  road  and  Cb  is  the  cost  of  travelling  a  unit  distance  in  back¬ 
ground  terrain.  Also,  tlierefore,  die  cost  of  travelling  from  the  point  of  entrance  onto  tiie  road  Pe  to  the  point 
of  exit  from  die  road  Px  is  CHPePx*  =  Cbsin(0c)-IPEPxl. 

The  cost  of  travelling  from  point  S  to  die  road  and  along  die  road  to  the  point  of  exit  Px  is  then  ISPcICb 
+  IPEPxIChsintGc)  =  CbdSPrJ  +  IPf-VxIsinlOc)).  Consider a.  right  triangle  widi  hypotenuse  PtiPx,  with  one  leg 
a  continuation  of  SPe  to  the  oilier  side  of  die  road  from  S  to  point  Q.  Now  IPeQI  =  IPEPxIsinCOb),  so  tiie  cost 
of  travelling  from  S  to  Pe  and  along  the  road  to  Px  is  CbOSPul  +  IPeQI)  =  QJSQI  since  S,  Pe.  and  Q  arc  colinear. 
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Figure  29 

Cost  Function  for  Road  Segment 


Thus,  (he  cost  from  any  point  S  to  move  to  a  road  and  travel  along  ii  to  some  point  Px  is  proportional  to  the 
distance  from  S  to  a  line  at  angle  6c  with  the  road  and  passing  through  Px.  But  by  this  description,  S  describes 
a  plane  which  intersects  line  QPx  lying  in  the  plane  of  (lie  map,  such  that  the  slope  of  the  plane  in  the  gradient 
direction  is  CbISQI/ISQI  =  Cb.  So  the  cost  function  associated  with  a  length-wise-travelled  edge  is  a  plane. 

A  third  type  of  region  root  is  an  edge  which  paths  cross,  obeying  Snell’s  Law  as  they  do  so.  As  each 
path  crosses  die  edge,  it  enters  a  region  where  the  cost  function  becomes  proportionally  greater  or  less  than 
before.  But  each  edge  which  is  crossed  according  to  Snell’s  Law  performs  a  transformation  on  the  current  cost 
function,  or  intuitively  speaking,  distorts  the  cost  function.  The  cost  function  associated  with  a  Snell  ’s-Law 
edge  is  therefore  a  distortion  of  the  cost  function  associated  with  the  parent  of  the  edge  in  the  optimal-path 
tree.  Thus  there  are  two  cost  functions  associated  with  Snell’s-Law  edges,  one  where  the  cone  of  apoint-type 
root  is  transformed  by  the  edge  resulting  in  a  distorted  cone,  and  one  where  the  plane  of  a  road-type  root  is 
transformed  by  the  edge,  resulting  in  a  plane.  For  regions  with  conical  cost  functions,  paths  which  crossed  into 
it  from  a  region  with  a  lower  cost  would  have  a  cost  function  which  was  a  flattened  "cone".  Paths  crossing  into 
it  from  a  region  with  a  higher  cost  would  have  a  cost  function  which  was  a  "cone"  with  greater  curvature.  For 
regions  with  planar  cost  functions,  higher-cost  adjacent  regions  would  have  a  more  sloped  cost  function,  while 
lower-cost  adjacent  regions  would  have  a  less  sloped  cost  function. 

There  arc  any  number  of  "higher-order"  cost  functions  associated  with  Snell’s-Law  edges  ending  in 
a  point.  For  example,  paths  could  cross  three  edges  enroule  to  a  point.  So  it  does  not  appear  to  be  possible  to 
derive  a  finite  number  of  analytic  characterizations  of  cost  xunctions  for  all  varieties  of  Snell’s-Law  edges. 
Note,  however,  that  although  a  cost  function  may  be  transformed  by  any  number  of  Snell’s-Law  edges,  it  has 
its  basis  in  eitlier  a  point  or  a  linearly-traversed  edge  root,  so  there  are  really  only  two  general  classifications 
of  Sncll’s-Law  cost  functions,  those  for  n  crossings  rooted  in  a  point,  and  those  for  n  crossings  rooted  in  a 
linearly-traversed  edge.  Once  a  sequence  of  region  roots  leads  back  to  a  point  or  a  traversed  edge,  a  fixed  cost 
is  associated  with  the  point  or  the  goal  end  of  lire  edge,  which  is  the  cost  from  that  point  to  the  goal,  and  so  no 
other  previous  information  about  cost  functions  remains  relevant. 

A  river  edge  can  also  be  a  region  root.  However,  since  a  river  edge  only  adds  a  fixed  amount  to  the 
cost  of  paths  which  cross  it,  it  serves  only  to  shift  vertically  by  a  fixed  amount  whatever  cost  function  occurs 
in  tltc  region  on  its  near  side,  and  so  cannot  be  said  to  have  a  characteristic  cost  function  of  its  own.  The  final 
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type  of  region  root  is  the  degenerate  one,  the  null  list,  adopted  by  convention  to  represent  regions  wliich  have 
no  feasible  patits,  for  example,  obstacle  interiors.  Since  lire  cost  of  a  path  in  the  degenerate  region  is  infinity, 
the.  cost  function  will  be  considered  undefined. 

Since  these  are  the  only  types  of  region  roots  which  occur  in  the  terrain  defined  for  this  research, 
there  are  only  three  general  types  of  cost  functions:  cones, planes,  and  various  orders  of  distorted  cones,  depend¬ 
ing  respectively  on  whether  the  region  has  a  point  as  its  root,  a  linearly-traversed-edge  or  one  or  more  Sneli’s- 
Law  edges  ending  in  a  linearly-traversed  edge  as  its  root,  or  finally  a  Snell’s-Law  edge  as  its  root  leading  to 
one  or  more  Snell ’s-Law  edges  and  a  point. 

2.  Boundaries  Between  Regions  as  Intersections  of  Cost  Functions 

The  occurrence  of  many  of  tire  simpler  types  of  boundaries  can  now  be  explained  in  terms  of  the  cost 
functions  of  the  region  roots  for  regions  which  the  boundary  separates.  Since  at  a  boundary  between  two 
regions,  the  cost  function  for  both  regions  applies,  it  must  be  that  the  boundary  is  the  projection  on  the  XY 
plane  of  tire  intersection  of  the  two  cost  functions.  The  intersection  of  two  cones  with  parallel  axes  is,  accord¬ 
ing  to  basic  analytic  geometry,  a  hyperbola,  and  so  it  becomes  clear  why  the  boundary  between  two  regions 
with  points  as  roots  is  always  a  hyperbola. 

The  boundary  between  a  region  whose  root  is  a  point  and  a  region  whose  root  is  a  road-segment  was 
determined  in  Section  A3  above  to  be  a  parabola.  Since  the  slope  of  the  plane  which  is  the  cost  function  of  the 
road-segment's  region  was  shown  above  to  be  the  cost  rate  of  the  background,  and  the  slope  of  the  cone  is  also 
the  cost  rate  of  the  background,  we  have  the  condition  which  specifies  in  intersecting  a  plane  with  a  cone  that 
(tie  intersection  is  a  parabola. 

The  intersection  of  two  planes  is  a  line,  so  tltc  boundary  between  regions  wliich  both  have  linearly- 
traversed  edges  as  roots  is  a  line  segment.  For  example,  the  hidden-edge  merging-path  boundary  of  a  high- 
cost,  external-goal  HCA  is  such  a  boundary,  and  as  shown  in  Section  A4a  above  is  indeed  a  line  segment. 

The  more  complicated  boundaries  involving  one  or  more  Snell’s-Law  edges  ending  in  a  point  also 
are  consistent  with  this  view,  although  the  mathematics  involved  in  computing  the  intersections  of  general¬ 
ized  shapes  is  complex.  Boundaries  involving  Snell  ’s-Law  edges  ending  in  a  linearly-traversed  edge  are  of  the 
same  types  as  those  involving  single  linearly-traversed  edges.  Since  there  arc  tlirce  general  types  of  cost  func¬ 
tions,  and  each  boundary  can  be  described  as  the  intersection  of  two  cost  functions,  there  arc  six  non-redun- 
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dant  ways  that  two  cost  junctions  may  intersect,  as  in  Table  5.  Each  entry  in  the  last  row  and  the  last  column 
depends  on  the  number  of  edges  crossed  by  the  region  root,  and  will  be  different  for  different  numbers  of 
edges.  For  some  cases,  a  boundary  listed  as  a  parabola,  hyperbola,  or  distorted  parabola  or  hyperbola  will 
degenerate  to  a  straight  line. 

A  view  which  takes  into  account  the  nature  of  the  cost  functions  associated  with  regions  which  are 
separated  by  boundaries  leads  to  a  more  unified  approach  to  the  derivation  of  the  analytical  forms  of  the  boun¬ 
daries.  This  view  will  become  important  in  the, process  of  merging  severed  single-feature  optimal-path  maps 
discussed  in  Chapter  VI,  since  there  will  be  too  many  possible  cases  of  region  intersections  to  derive  each 
analytical  form  case  by  case.  The  above  six  forms  will  provide  the  basis  for  a  general  solution  to  the  problem 
of  merging  OPM ’s. 
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TABLE  5 


BOUNDARY  TYPES  BY  REGION  ROOT  PAIRS 


Region  Root  Type  (cost  function  tvpet 


point 

liosarly-uaveiscdcdge 

S-L  edge  to  pt 

(cone) 

(plane) 

(distorted  cone) 

point 

(cone) 

hyperbola 

parabola 

distorted 

hyperbola 

litwfirfv-traversed  edge 
(plane) 

parabola 

line 

distorted 

parabola 

S.-L.ctlgc  lo  pt 

distorted 

distorted 

distorted 

(distorted  cone) 

hyperbola 

parabola 

hyperbola 

106 


VI.  ALGORITHMS  FOR  OPM  CONSTRUCTION  BASED  ON  SPATIAL 

REASONING 


A.  OPTIMAL-PATH  TREE  CONSTRUCTION 

The  fiist  step  in  constructing  an  optimal-path  map  is  to  build  an  optimal-path  tree  (OPT).  A  straightfor¬ 
ward  way  to  do  this  is  presented  here,  although  a  more  efficient  way  would  be  to  build  the  OPT  during  the  ex¬ 
ecution  of  an  algorithm  such  as  recursive- wedge  decomposition  or  the  continuous-Dijkstra  algorithm:  A  set 
of  optimal  paths  from  the  goal  point  to  each  terrain-feature  vertex  is  computed  using  any  point-to-point  path¬ 
planning  algorithm.  The  turn  points  of  these  optimal  paths  are  then  sequentially  inserted  into  the  OPT  by  scan¬ 
ning  each  path  list  from  the  goal  point  to  its  start  point  as  the  OPT  is  traversed  from  its  root  (the  goal)  through 
its  internal  nodes.,  matching  nodes  of  the  tree  with  turn  points  of  the  path. 

As  the  insertion  algorithm  traverses  the  OPT,  a  pointer  identifies  the  current  node.  A  pointer  also  iden¬ 
tifies  the  current  element  of  the  path  list.  If  the  current  node  has  a  child  node  which  matches  the  current  ele¬ 
ment  of  the  path  list,  the  child  node  becomes  the  current  node  and  the  next  element  on  the  path  list  becomes 
the  current  one.  If  the  current  node  has  no  child  node  which  matches  the  current  path-list  element,  a  new  node 
is  created  which  matches  the  path-list  element  and  whose  parent  is  the  current  node.  Then  as  before,  the  child 
node  becomes  tlie  current  node  and  the  next  path-list  element  becomes  the  current  one.  When  the  end  of  the 
path  list  is  reached,  the  insertion  is  complete.  Wlien  all  the  lerrain-feature-vertex  optimal  paths  have  been  in¬ 
serted  into  the  OPT,  one  final  node  representing  the  empty  path  list  (for  "start"  points  with  no  feasible  paths, 
as  for  example  in  the  middle  of  an  obstacle)  is  inserted  as  a  child  of  the  root  node  and  the  initial  OPT  is  com¬ 
plete. 


B.  BASIC  ALGORITHMS  FOR  ISOLATED  TERRAIN  FEATURES 


First,  we  present  algorithms  to  construct  planarpartilions  for  fourtypes  of  isolated  single  terrain  features, 


£» '  vi *  vj.uuuu  j.4ui  uvkj  a «>v  ptuuuvti!  oivi>£  ntutiu  upuimu  puu>  ux.V|  wiupidvo 


An  algorithm  is  presented  for  obstacle,  river  segment,  and  road  segment  primitives,  and  for  each  of  the  four 
cases  associated  with  homogeneous-cost  areas  (HCA). 
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1.  An  Algorithm  for  OPM  Construction  for  A  Single  Obstacle 

For  a  single  obstacle  in  a  homogeneous-cost  background  (see  Figure  17),  the  algorithm  to  construct 
the  optimal-path  map  with  respect  to  a  certain  goal  point,  given  the  optimal-path  tree,  is  straightforward.  The 
OPT  for  a  single  obstacle  will  have  three  branches  from  the  root,  one  of  which  will  consist  only  of  the  empty 
node.  Each  of  the  other  two  branches  will  consist  of  one  chain  of  nodes  representing  vertices  on  one  side  or 
the  other  of  the  obstacle.  The  algorithm  begins  by  taking  the  obstacle  edges  as  the  starting  set  of  homogeneous- 
behavior  boundaries.  Then  it  constructs  all  the  shadow  boundaries  by  traversing  down  llie  two  branches  of  the 
optimal-path  tree  whose  nodes  represent  vertices  on  opposite  sides  of  the  obstacle,  creating  a  shadow  bound¬ 
ary  for  each  edge  of  the  tree  until  it  finds  tire  leaf  node  of  each  branch.  Then  it  constructs  the  opposite-edge 
boundary  starting  with  the  hyperbola  generated  by  the  two  vertices  of  the  opposite  edge  and  sweeping  away 
from  the  goal.  Each  time  the  current  segment  of  the  opposite-edge  boundary  intersects  a  shadow  boundary,  a 
new  pair  of  foci  is  determined,  and  the  new  hyperbola  segment  is  constructed.  The  algorithm  is  finished  when 
the  opposite-edge  boundary  does  not  intersect  any  more  shadow  boundaries. 

Table  6  (on  two  pages)  shows  the  algorithm  for  construction  of  a  single  obstacle  OPM.  Algorithms 
arc  presented  using  standard  procedural  conventions  as  in  Chapter  111,  with  natural-language  explanations  sub¬ 
stituting  for  rigorous  notation  where  possible  without  ambiguity.  The  input  to  each  algorithm  is  a  representation 
of  the  terrain  feature  and  an  optimal-path  tree,  representing  (be  optimal  paths  from  each  terrain-feature  ver¬ 
tex.  The  doubly-connected-edge-list  (DCEL)  data  structure  presented  in  Chapter  II,  Section  A  is  used  to  rep¬ 
resent  the  planar  partition.  We  assume  that  Iow-Ievcl  algorithms  are  available  to  manipulate  the  DCEL,  for 
example,  insert-into-dcel.  Assume  also  that  specifying  an  optimal-path  tree  node  is  equivalent  to  specifying 
the  coordinates  of  the  vertex  represented  by  it,  as  well  as  the  cost  of  the  optimal  path  from  the  vertex  to  the 
goal. 

Tire procedurcadd-obstacle-opposite-«dga-bdrjiscal]edby  the  algorithm  to  construct  tire  opposite- 
edge  boundary  as  it  lies  outward  from  the  obstacle.  It  docs  this  by  finding,  if  they  exist,  points  of  intersection 
with  the  shadow  boundaries  from  the  two  vertices  which  serve  as  the  foci  of  the  hyperbola  which  is  the  active 
portion  of  the  opposite-edge  boundary,  and  choosing  the  one  which  occurs  closest  to  the  obstacle.  Both  the 
shadow  boundary  and  the  hyperbola  are  truncated  at  tliis  point,  and  new  foci  and  a  new  hyperbola  are  deter¬ 
mined.  This  hyperbola  becomes  tire  active  portion  of  tire  opposite-edge  boundary,  and  new  shadow  boundaries 
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TABLE 6 


OBSTACLE  OPM  ALGORITHM 


algorithm  single-obstacle-opm:  (Algorithm  VI-1) 

input:  Optimal-Path  Tree  with  root  node  N 
and  associated  obstacle  edge-list  0; 
output:  Optimal-Path  Map  M  (a  DCEL) 
and  modified  Optimal-Path  Tree  N; 
purpose:  to  construct  an  OPM  for  a  single  obstacle; 


/*  insert  obstacle  edges  into  DCEL.  */ 


{ 

M  :=  empty  dcel  structure; 
while  (0  is  not  empty) 

I 

insert-into-dcei(M, First  edge  of  0): 
O  :=  O  less  first  edge  of  0; 

} 

Nprev  :=  N; 
j:=l; 

for  each  child-node  of  N 

{ 

Ncurr  :=  child-node(N): 
if  Ncurr  has  a  child  node 
{ 

until  Ncurr  has  no  child  nodes 

I 

Nprev :—  Ncurd 
Bdry  :=  Line  NCurrNp,ev 
less  ray  Nci.rrNprev ; 
insert-uito-dcd(M,Bdry); 

) 

Oppositc-edgc-vertexj  :=  Ncurr : 

j  :=  j  +  l; 

} 

) 

for  j  :=  1  to  2 

I 

Focusj  :=  Opposite-edge-vertexj; 
Costj  :=  cost  of  optimal  path  from 
Opposite-edge-vertexj; 

) 

add-obst-opp-edge-bdry 

(FOCUS  1  ,C0Sl  |  ,FoCUS2,CoSt2,M,N); 

1 


/*  initialize  Nprev  to  Goal.  7 
I*  construct  shadow  boundaries.  7 

/*  ie,  if  node  is  not  a  leaf  node.  */ 

/*  ie,  if  node  is  a  region  root  */ 

/*  traverse  to  bottom  of  this  branch.  */ 

/*  ie,  ray  starting  at  NCUfr  and  */ 

/♦  lying  away  front  Nprev.  7 

/♦  add  shadow  boundary  to  DCEL.  */ 

/*  note:  there  are  exactly  two  such  vertices.  7 


/*  construct  opp-edge  bdry.  7 

I*  end  of  single-obstacle-opm  Algorithm  7 
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TABLE  6  (CONTINUED) 
OBSTACLE  OPM  ALGORITHM 


procedure  add-obstacle-opposite-edge- boundary 
input:  coordinates  and  optimal  costs  from  opposite-edge 
vertices,  shadow  bdrys  represented  in  DCEL  M,  and  optimal-path  tree  N; 
output:  revised  DCEL  M; 

purpose:  to  build  the  opposite-edge  bdry  by  concatenating  successive  hyperbola  segments; 

{ 

ShadBdryi  :=  shadow  bdry  from  Vertexi; 

ShadBdiy2  :=  shadow  bdry  from  Vertex2; 

repeal  until  neither  shadow  boundary  intersects  the  hyperbola; 

I 

Bdry  :=  segment  of  hyperbola  branch  such  that  / ♦  initialize  Bdry  to  initial  leg  starting  at  */ 

Focus  i  :=  Vertex) ,  Focus2  :=  Vertex2,  /*  obstacle  opposite-edge.  */ 

hyperbolic  constant  :=  abs(Cost  i  -  Cost2), 
and  segment  lies  away  from  goal; 

Intersea  i  :=  point  of  intersection  of  Bdry 
with  shadow  bdry  from  Focusi; 

Intersect2  :=  point  of  intersection  of  Bdry 
with  shadow  bdry  from  Focus2; 
if  at  least  one  shadow  bdry  intersects  Bdry 
{ 

j  :=j  which  minimizes  length  from  the  beginning 
of  Bdry  to  Intersectj ; 

Bdry  :=  portion  of  Bdry  between  its  beginning 
and  Intersectj; 

iiis*rt-into-dcri(M,Bdry);  /*  add  current  segment  of  opp-e.  bdry  to  DCEL.  */ 

Bdry  :=  segment  of  hyperbola  branch  starting  /♦  get  next  segment  of  opposite-edge  bdry.  */ 

at  Interseaj  such  that  Focusj  :=  parent-node(Focusj), 

Costj  =  Cost  of  Focusj,  hyperbolic  constant 
:=  abs(Costi  -  Cost2),  and  segment  lies  away  from  goal; 

ShadBdryj  :=  shadow  bdry  from  Vertexj;  /*  substitute  new  shadow  bdry  from  new  focus.  */ 

} 

else  insert-into-dcel(M,Bdry); 

} 


1 


I*  add  last  segment  of  opp-edge  bdry  to  DCEL  *1 
/*  end  of  add-obstade-opp-edge-boundary  +/ 


are  checked  for  intersections.  When  no  intersections  are  found,  the  procedure  is  finished  and  the  opposite-edge 
boundary  is  the  concatenation  of  all  the  hyperbola  segments. 

The  algorithm  of  Mitchell  [Ref.  4]  also  builds  an  optimal-path  map  for  an  obstacle.  It  allows  for  mul¬ 
tiple  obstacles,  as  does  Algorithm  VI-l  used  in  conjunction  with  Algorithm  VI-9  below,  and  also  depends  on 
the  analytical  characterization  of  homogeneous-behavior  boundaries  as  line  segments  or  sequences  of  con¬ 
nected  hyperbola  segments.  His  algorithm  uses  the  notion  of  generalized  visibility  to  build  successive  sub- 
OPMs.  It  merges  OPMs  using  Voronoi-diagram  construction  methods  from  computational  geometry,  while 
algorithm  VI-9  must  use  a  more  ad  hoc  approach,  since  Voronoi  diagrams  for  the  more  general  terrain  fea¬ 
tures  we  consider  are  not  available. 

2.  An  Algorithm  for  OPM  Construction  for  A  Sin  gle  River  Segment 

The  algorithm  to  construct  the  planar  partition  for  a  single  river  segment  is  similarly  straightforward 
(see  Figure  18).  In  this  case,  exactly  two  shadow  boundaries,  at  most  two  river-crossing  boundaries  and  one 
opposite-edge  boundary  need  to  be  constructed.  If  the  river-crossing  boundaries  intersect,  the  opposite-edge 
boundary  will  begin  at  their  point  of  intersection.  Otherwise,  no  opposite-edge  boundary  will  exist  A  change 
from  the  obstacle  algorithm  is  the  addition  to  the  optimal-path  tree  of  edges  which  are  crossed  by  paths,  since 
these  are  homogeneous-behavior  region  roots.  Table  7  shows  the  river-OPM  construction  algorithm. 

As  discussed  in  Chapter  I,  it  is  possible  to  model  rivers,  as  well  as  obstacles  and  roads,  as 
homogeneous-cost  areas,  and  so  Algorithms  VI-4  and  VI-6  could  be  used  instead  of  Algorithms  VI-1,  Vl-2, 
and  VI-3.  But  these  first  three  algorithms  are  simpler. 

3.  An  Algorithm  for  OPM  Construction  for  A  Single  Road  Segment 

The  algorithm  for  a  single  road  segment  is  somewhat  more  complicated,  although  still  straightfor¬ 
ward  (see  Table  8).  As  discussed  in  Chapter  V  (see  Figures  19, 20,  and  21),  the  boundaries  which  will  exist 
for  a  road  segment  are  determined  by  the  positioning  of  the  characteristic  wedge  with  respect  to  the  road  ver¬ 
tices.  Therefore,  top-level  decision  logic  for  the  algorithm  is  based  on  the  position  of  the  characteristic  wedge. 
Procedure  coostruct-rd-bdry  is  called  to  compute  each  specific  boundary. 

4.  An  Algorithm  for  A  Single  Convex  High-Cost  Exterior-Goal  Homogeneous-Cost  Area 

The  algorithm  to  compute  the  planar  partition  for  high-cost  area  with  an  externa!  goal  is  called  bca- 
opm-high-ext  (see  Table  9).  The  equations  for  each  boundary  can  be  found  in  Appendix  A  in  the  Lemma  cor- 
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TABLE 7 


RIVER-SEGMENT  OPM  ALGORITHM 


algorithm  single-river-segment-opm  (Algorithm  VI-2) 

input:  Optimal-Path  Tree  with  root  node  N  and  associated  river  edge-list  R  with  cost  G; 
output:  Optimal-Path  Map  M  (a  DCEL)  and  modified  Optimal-Path  Tree  N; 
purpose:  to  construct  an  OPM  for  a  single  isolated  river  segment; 

I 

M  :=  empty  dcel  structure; 

for  New  :=  each  river-vertex  child-node  of  N  /*  construct  shadow  boundaries  */ 


Bdry  :=  Line  NCwN  less  Half-line  NCwN; 
insert -int  o-dcel(M,B  dry); 


/*  ie,  half-line  starting  at  New,  away  from  goal  */ 
l*  add  shadow  boundary  to  DCEL.  */ 


forj  :=  1  to  2 

{ 

Focusj  :=  River-Vertexj; 

Costj  :=  cost  of  optimal  path  from  River- Vertexj; 

Bdryj  :=  segment  of  hyperbola  branch  with  foci  /*  river-crossing  bdry  for  each  river  vertex.  */ 

Focusj  and  Goal,  hyp  constant  =  abs(Costj  •  Cr), 
such  that  branch  is  closer  to  Focusj; 

if  Bdryj  intersects  river  segment  /*  if  so,  End  intersection  point  */ 

Intersect)  :=  intersection  print; 
else 

Bdryj  :=  null  list;  /*  if  not,  river-crossing  bdry  does  not  exis 

} 

if  Bdry  i  is  not  null  /*  (neither  bdry  or  both  bdrys  will  be  null) 

{  ’ 

Intersect  1,2  :=*  intersection  of  Bdry  i  and  Bdry2 ; 

Bdryi  :=  Bdryi  from  Intersecti  to  Intersect  1,2 ; 

Bdry 2  :*  B<lry2  from  Intersect2  to  Intersect  1,2 ; 

insert-into-dcel(M,Bdry  1);  /*  add  river-crossing  bdry  1  to  DCEL.  */ 

insert-into-«kd(MBdry2);  /♦  add  river-crossing  bdry  2  to  DCEL.  */ 

Bdry  :=  segment  of  hyperbola  branch  with  /*  find  opposite-edge  bdry.  */ 

Focus  1  and  Focus2,  hyperbolic  constant  = 
abs(Costt  -  Cost2),  such  that  branch  is  closer 
to  the  higher-cost  focus,  with  starting  point  at 
Intersecti  a  lying  away  from  goal; 

River-edgei^ :»  Line  from  Intersecti  to  Iatersect2 ; 

lna*rt-htto-op<(NJRiver-edgeu);  /•  add  river-crossing  edge  to  Optimal-Fat! 

} 

else 

Bdry  :=  segment  of  hyperbola  branch  with  l*  find  opp-edge  bdry  if  no  river-crossing ! 

Focus  1  and  Focus  2,  hyperbolic.  constant » 
abs(Cost'  -  Cost2),  such  to  branch  is  closer 

»*•  twJrii  at 

W  Uiv  tu^uvr*vwv  t»  *vs»  uvvietMi^  j^vion  %** 

intersection  of  hyp  sod  river,  lying  away  fiwu  goal; 

Kaaert-loto-dcdCMd-ioe  from  Focus  i  to  Focus2);  /*  add  river  edge  sw  bdry  ♦/ 

insert-int<Mkri(M,Bdry);  /*  add  oppoeite-edge  bdry  to  DCEL  */ 

}  /*  end  of  shagle-river-opm  Algorithm  */ 


/*  if  so,  find  intersection  point  */ 


/*  if  not,  river-crossing  bdry  does  not  exist  */ 
/*  (neither  bdry  or  both  bdrys  will  be  null)  */ 


/*  add  river-crossing  bdry  1  to  DCEL.  */ 
/♦  add  river-crossing  bdry  2  to  DCEL.  */ 
/*  find  opposite-edge  bdry.  */ 


/•  add  river-crossingedge  to  Optimal-FathTree.  *1 


l*  find  opp-edge  bdry  if  no  river-crossiag  bdrys.  */ 


/♦  add  river  edge  sbj  bdry  ♦/ 
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TABLE  3 

ROAD-SEGMENT  OPM  ALGORITHM 


algorithm  single-road-segment-opm  (Algorithm  VI-3) 

input:  Optimal-Path  Tree  with  root  node  N  and  associated  road  edge-list  R  with  cost  Cr; 
output:  Optimal-.Patli  Map  M  (a  DCEL)  and  modified  Optimal-Path  Tree  N; 
purpose:  to  construct  an  OPM  for  a  single,  isolated  road  segment; 

I 

M  :=  empty  dcel  structure; 

0c  :=*  sin  ^(C«/CbKkgi'ound); 

Wedge-Ray t  :=  ray  from  G  intersecting  road  VtV2 
at  Pt  A  such  that  ZGAV2  *7C/2  —  9e; 

Wedge-Ray2  :=»  ray  from  G  intersecting  road  V1V2 
at  Pt  B  such  that  ZGBVi  =  n/2  —  9C; 
ifpts  A,  B,  and  V|  are  ordered  "BAVt" 

( 

constroct-rd-bdryfroad-end/travell  ing.Vj); 
constr»ct-rd-bdr  y(road-end/goal,  V 1); 
construct-rd-bdry(near-side-n?ad-travelling/goal,V|); 

ifpts  A3,  &  V2  are  not  ordered  "V2AB"  /*  if  in  addition  wedge  is  not  "outside"  V2,  */ 

constnict-rd-bdryfroad-travelling/crossing.Vi);  /*  generate  type  e  bdry  on  Vi  end.  7 

I 

else  if  they  are  ordered  "B  V|  A"  /*  wedge  "straddles”  Vi  so  generate  boundary  7 

construct-rd-bdry(road-shadow,V|);  /*  type  g  on  the  Vi  end  ♦/ 

else  if  they  arc  onlered  "ViBA"  /*  wedge  is  "outside"  Vi  so  generate  boundary  */ 

( 

const n»ct-rd-bdry(near-3ide-rd-travell,g/gcKd.'V2)  /*  types  d  on  the  V2  end  and  f  on  the  Vi  end  7 
constnict-rd-bdry(far-side-road-travelling/goal,V2); 

) 

if  pts  A,  B,  and  V2  are  ordered  "AB V2"  /*  wedge  is  "inside"  V2  so  generate  boundary  */ 

{ 

constr»ct-rd-bdry(road-endAravel]ing,V2);  /•  types  b,c  and  d  on  the  V2  end.  7 
const  n»ct-rd-bdry(road-end/goal,V2); 
constmct-rd-bdryfncax-skle-road-travelling/goal.Vz); 

ifpts  A3.  &  Vt  are  not  ordered  "V|BA"  /*  if  in  addition  wedge  is  not  "outside"  V|,  */ 

constrwct-rd-bdrj(road-travelling/crossing,V2);  /*  generate  type  e  bdry  on  V2  end.  */ 

1 

else  if  they  are  ordered  "AV2B"  /*  wedge  "straddles"  V2  so  generate  boundary  */ 

comtruct-rd-bdry(road-chadow,V2);  /*  type  g  on  the  V2  end.  */ 

else  if  they  are  ordered  "V2AB"  /*  wedge  is  "  outside"  V2  so  generate  boundary  7 

{ 

constnKt-rd-bdryfnear-skie-nl-traveU’g/gwd.Vi); /•  types  doa  the  Vi  end  and  f  on  the  V2  end.  */ 
construct-rd-bdryffar-side-road-travelling/goal.Vi); 

) 

}  /*  end  of  single-road-opm  algorithm  7 


/*  road  critical  angle  7 

/*  A  is  oriented  to  B  as  Vi  is  to  V2  (see  Chap  V)7 
/*  wedge  is  "inside"  Vi  so  generate  boundary  7 

/♦  types  b,c  and  don  the  Vi  end.  7 
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TABLE  8  (CONTINUED) 
ROAD-SEGMENT  OPM  ALGORITHM 


procedure  construct *rd*bdry 

;  input:  type  of  bdry  T,  vertex  V  of  road,  DCEL  M,  Optimal-Path-Tree  N,  and  Wedge-Ray  1  and  Wcdge-Ray2 
output:  revised  DCEL  M  and  revised  OPT  N; 
purpose:  construct  each  road-generated  boundary  of  type  T; 

(j  :=  3-i;  /*  if  i=l,  j=2  and  if  i=2,  j=l,  i.e.,  j  is  other  end  */ 

if  T  =  road-end/travelling  /*  Type  "b”  boundary  */ 

{ Bdry  i  :=  Ray  with  vertex  Vi,  lying  on  line  ViX,  such  that  ZVjVtX  =  7t/2+0c; 

Bdry2  :=  Ray  with  vertex  Vi,  lying  on  line  ViY,  such  that  ZVjViY  =  37E/2-0c; 
insert-into-dcel(M,Bdry i);  /*  add  road-end/travelling  boundary  to  DCEL.  */ 

insert-into-dcd(M3dry2);  /*  add  road-end/travelling  boundary  to  DCEL.  */ 

) 

else  if  T  =  road-end/goal  /*  Type  "c"  boundary  */ 

{ Bdry  :=  the  branch  closer  to  Vj  of  a  hyperbola  with  foci  Vi  and  Goal,  and  hyp.  <  onstant  =  cost  from 
Vi  to  Goal  via  road,  starting  at  point  of  intersection  between  hyperbola  and  type  b  bdry  from  Vi; 
insert-into-dcd(M3dry);  /*  add  road-end/goai  boundary  to  DCEL.  */ 

} 

else  if  T  =  near-side-road-travelling/goal  /*  Type  ”d"  boundary  */ 

( if  (wedge  is  cot  outside  Vj)  /*  wedge  is  inside  Vi  &  not  outside  Vj  */ 

Bdry  :=  segment  of  parab.  s.t.  focus  -  Goal,  and  directrix  D-LWedge-Rayj  with  D  being  IGPI  from  P 
(P=A  if  i— 1,  else  P=B),  starts  at  P,  lies  away  from  Goal,  ends  at  inters,  with  type  b  bdry  from  Vi; 
else  /*  wedge  is  inside  Vj  &  outside  Vj  */ 

Bdry  :=  segment  of  parabola  with  focus  =  Goal  and  directrix  »  line  L,  LJLWedge-Rayj  such  that  L  is 
IGVjl  from  Vj,  starting  at  P  :=  Vj,  lying  away  from  Goal,  ending  at  inters,  with  type  b  bdry  from  V;; 
insert  4nto-dcei(M,Bdry);  /*  add  near-side-road-trvlg/goal  bdry  to  DCEL.  ♦/ 

iruert-into-opt  (N,PVj,Near-side);  /*•  add  travelled  road  segment  to  OPT.  */ 

insert-into-dcet(M,PV|);  /*  add  travelled  segment  as  edge  bdry  to  DCEL  */ 

) 

else  if  T  *  road-travelling/crossing  /*  Type  "e"  boundary  */ 

{ Bdry  :=  ray  starting  at  P  and  lying  along  Wedge-Rayi, 

(where  P=A  if  i=l  and  P=B  if  i=2),  lying  away  from  Goal; 

Inaert-into-dceKMJBdry);  /♦  add  road-travelling/crossing  bdry  to  DCEL.*/ 

iruert-into-opt  (N.edge  PViJFar-side);  /*  add  road  segment  which  is  travelled  to  OPT.  */ 

insert-into-dceKM^Vi);  /*  add  travelled  segment  as  edge  bdry  to  DCEL  */ 

) 

else  if  T  =  far-side-road-lravelling/goal  /*  Type  T  boundary  */ 

(iruert-into-opt  (N,V-,Vj,Near-side); 
iruert-into-opt  (N,ViVjFar-skJe); 

iiuert-into-dcei  (MJine  ViVj);  /*  road-edge  boundary  added  to  DCEL  */ 

fork:=  1  to  2 

(Bdryk  :=  segment  of  parabola  with  focus  =  Goal,  and  directrix  =  line  L,  LJLWedge- 
Rayk  such  that  L  is  (GVjl  from  Vi,  starting  at  Vi  and  lying  away  from  Goal; 
insert-into-dcel(M3dryk);  /*  add  far-side-road-trvlg/goal  bdrys  to  DCEL.  */ 

1 

)  ‘ 

else  if  T  =  road-shadow  /*  Type  "g"  boundary  */ 

( Bdry  :=  ray  from  Vi  along  line  ViG,  lying  away  from  Goal; 

insert-into-dcei(M3dry);  /*  add  road-sbadow  bdry  to  DCEL  */ 

I 

)  /*  end  of  construct-rd-bdry  */ 
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TABLE  9 

HIGH-COST  EXTERIOR-GOAL  HCA  OPM  CONSTRUCTION  ALGORITHM 


algorithm  hca-opm-high-ext  (algorithm  VI-4) 

input:  Optimal-Path  Tree  N,  HCA  A  with  □  vertices: 
output:  DCEL  M.  and  modified  OPT  N; 
purpose:  to  construct  the  OPM  for  a  high-cost,  exterior-goal  HCA. 

{ 

for  i  :=  1  to  n  /*  add  interior  bdry  for  each  vertex.  */ 

S 

ifedgeiis  visible 
ifedgei+1  is  visible 

B  :=  value  returned  by  construct-high-ext-hca-bdry("visible-edge",i); 
else 

B  :=  value  returned  by  constinct-high-ext-Iica-bdrj("visible-hidden"li); 
else  if  edge  i  is  hidden 
if  edge  i+1  is  visible 

B  :=  value  returned  by  construct-high-ext-hca-bdry("visible-liidden"li-t-l); 
else 

if  edges  are  on  different  sides  of  opposite  edge 
B  :=  value  returned  by  coostr»ct-high-«xl-bca-bdr7("hidden/divergiDg",i); 
else 

B  :=  value  returned  by  constn»ct-b4jh-«xt-hca-bdr7("hid<kn/merging",i)- 
add  B  to  BdrySet; 

} 

BdrySet  :=  value  returned  by  pair-and-merge-bdrys  /*  join  interior  bdrys  together.  */ 
(BdrySet,"high-ext-bca-interior”); 
form  BdryTrees  from  bdrys  in  BdrySet; 
for  each  BdryTree 
( 

find  point  X  at  which  BdryTree  /♦  there  will  be  exactly  one  X  per  tree  ♦/ 

intersects  an  opposite  edge; 

B  :*  value  returned  by  co*utn»ct-hlgh-ext-bca-bdr7("oppcsite-edge"X): 
add  B  to  OEBdrySet; 

I 

fori :« 1  ton 

if  Vt  connects  a  visible  and  a  hidden  edge 

I 

if  Vi  is  not  connected  to  any  interior  BdryTree 
add  conatnKt-h4gh-*xt-bca-bdry("corner-cutiing"X)  to  BdrySet; 

B  >  value  returned  by  cooatr«ct-high-ext-bca-bdrj("shadow,’,i); 
j  :*  other  vertex  of  E| 

while  Ej  is  not  an  opposite  edge  /♦  work  around  the  HCA  creating  shadow  ♦/ 

(  /*  bdrys  until  the  opposite  edge  is  found.  */ 

B  :■  value  relumed  by  constrwct-hi^t-ext-bca-bdr7(,,shadow"J); 
j  :=  other  vertex  ofEi 
) 

1 

B  :*  value  returned  by  pair-and-merge-bdrys  /•  join  opposite-edge  bdrys  together.  */ 
(OEBdrySet, "high-ext-hc*-exterior"); 
add  B  to  BdrySet; 
for  all  B  €  BdrySet 
insert-into-dcd(M,B); 

}  /♦  end  of  bca-opm-high-ext  */ 
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TABLE  9  (CONTINUED) 

HIGH-COST  EXTERIOR-GOAL  HCA  OPM  CONSTRUCTION  ALGORITHM 


procedure  pair-and-merge-bdrys  /*  join  connecting  bdrys  together.  */ 

input:  BdrySet,  and  type  of  region; 
output:  revised  BdrySet; 

purpose:  to  take  an  initial  set  of  boundaries,  pair  the  ones  which  first  intersect  each  other,  end 
propagate  a  new  bdry  from  each  intersected  pair,  continuing  until  all  appropriate  bdrys  axe  joined. 

{ 

while  BdrySet  is  changing 

l 

PairedBdrySet  :=  BdrySet; 
while  PairedBdrySet  is  changing 
l 

for  all  Bye  PairedBdrySet  where  By  is  unmarked 

( 

discard  Bi.j  from  PairedBdrySet; 
add  By  from  B-'rySei  to  PairedBdrySet; 
intersect  By  with  Bhj  and  truncate  both; 
add  Bb/^and  By'ronc  to  PairedBdrySet; 
intersect  By  with  Bu  andtruncate  both; 
add  Bij*™"0  and  BixitWK  :=  to  PairedBdrySet; 

1 

for  all  Bye  PairedBdrySet 
discard  all  but  the  shortest  By  from  PairedBdrySet; 
unmade  all  bdrys  in  PairedBdrySet; 
for  all  By  and  Bj^e  PairedBdrySet  sudi  that  By  adjoins  Bj,k 
mark  By  and  Bj£ 

) 

for  all  Byand  Bj,k€  PairedBdrySet  such  that  By  adjoins  Bj,k 
add  Bt,k  to  PairedBdrySet; 

BdrySet  :=  PairedBdrySet; 

) 

j  /*  end  of  pair-and-merge-bdrys.  */ 
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TABLE  9  (CONTINUED) 

HIGH-COST  EXTERIOR-GOAL  HCA  OPM  CONSTRUCTION  ALGORITHM 


procedure  construct-high-ext-hca-bdry  /*  provides  methods  to  construct  each  type  of  */ 

input:  type  of  bdry  T;  index  of  vertex  i;  /*  bdry  of  high-cost,  exterior-goal  HCA.  */ 

output:  Bdry,  the  resulting  boundary; 
purpose:  to  construct  a  boundary  generated  by  vertex  i  of  type  T; 

{ 

if  T  =  "visible-edge” 

Bdry  :=  curve  as  specified  in  Lemma  V-4.1; 
if  T  =  "visible-hidden" 

Bdry  :=  curve  as  specified  in  Lemma  V-4.2; 
if  I  =  "merging" 

Bdry  :=  curve  as  specified  in  Lemma  V-4.3; 
if  T  =  "diverging" 

Bdry  :=  curve  as  specified  in  Lemma  V-4.4; 
if  T  =  "hca-edge" 

Bdry  :=  curve  as  specified  in  Lemma  V-4.7; 
ifT=  "shadow" 

Bdry  :=  curve  as  specified  in  Lemma  V-4.8; 
if  T  =  "opposite-edge" 

Bdry  :=  curve  as  specified  in  Lemma  V-4.9; 
if  T  =  "comer-culling" 

Bdry  :=  carve  as  specified  in  Lemma  V-4. 10, 

I 


/♦end  of  const  ruct-high-ext-hca-bdry  ♦/ 


responding  to  the  boundary  type  (see  also  Figures  23, 24,  and  25).  Each  vertex  of  such  a  HCA  is  associated 
with  an  internal  boundary,  whose  character  depends  on  whether  the  edges  incident  to  the  vertex  are  visible  or 
hidden  (and  for  vertices  on  two  hidden  edges,  on  whether  the  vertices  nearest  the  goal  for  each  edge  have  op¬ 
timal  paths  which  go  in  the  same,  or  different  directions  around  the  HCA,  called  merging  or  diverging  paths 
respectively).  These  boundaries  are  computed  first,  and  then  procedure  palr-and-merge-bdrys  constructs  a 
network  (or  networks)  of  interior  boundaries  which  is  connected  to  the  initially-computed  boundaries.  This 
procedure  pairs  boundaries  which  intersect,  and  then  plots  a  new  boundary  which  has  an  endpoint  at  the  point 
of  intersection  of  the  paired  boundaries.  It  continues  pairing  boundaries  ard  plotting  new  ones  until  all  the 
boundaries  are  joined  together  on  both  ends  or  intersect  an  edge  of  the  HCA.  Note  that  deciding  which  ad¬ 
jacent  boundaries  should  be  paired  together  is  not  simple,  and  it  may  take  severel  iterations  for  the  procedure 
to  settle  on  a  correct  configuration. 

The  interior  boundaries  are  then  joined  into  trees,  and  since  each  interior  boundary  tree  intersects  an 
opposite  edge  exactly  once,  this  can  serve  to  begin  generation  of  the  external  opposite-edge  boundaries.  In 
contrast  to  obstacles,  there  can  be  several  HCA  opposite  edges  and  opposite-edge  boundaries.  Comer-cutting 
boundaries  are  indicated  when  an  interior  boundary  associated  with  a  vertex  actually  begins,  not  at  the  vertex, 
but  somewhere  along  the  boundary.  Tbs  algorithm  next  checks  for  this  situation,  which  can  only  happen  with 
respect  to  a  vertex  joining  a  hidden  and  a  visible  edge.  This  type '  -rtex  is  also  a  good  place  to  begin  generat¬ 
ing  shadow  boundaries.  Finally,  procedure  pair-and-ntw ge-bdrys  is  again  used,  this  time  with  the  exterior 
shadow  and  opposite-edge  boundaries. 

Figures  30, 3 1,  and  32  illustrate  the  state  of  procedure  pair-and-merge-bdrys  at  various  intermediate 
stages  in  its  execution  for  the  example  HCAs  of  Figures  23, 24,  and  25  respectively.  Edges  of  the  HCAs  are 
numbered,  and  boundaries  are  labeled  "ij",  where  i  and  j  represent  the  edges  crossed  by  paths  on  either  side 
of  tbe  boundary.  Boundaries  which  are  paired  with  another  boundary  at  each  stage  are  noted  by  an  asterisk. 
Boundaries  which  are  stored  in  the  data  structure  PairedBdrySet  are  noted  in  the  figures  as  dark  lines.  Figure 
30a,  31a,  and  32a  show  the  interior  boundaries  associated  with  each  terrain-feature  vertex  at  the  beginning  of 
the  algorithm  (beginning  at  the  vertex  or  associated  short-cutting  point,  extending  indefinitely  into  the  inte¬ 
rior  and  then  beyond.  The  current  set  of  interior-boundary  trees  is  also  shown,  with  each  node  labeled  by  tnc 
boundary  it  represents. 
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Figure  30 

Construction  of  HCA  Interior-Boundary  Tree  Example  1 
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Figure  31a 

Construction  of  HCA  Interior-Boundary  Tree  Example  2 
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Figure  32 

Construction  of  HCA  Interior-Boundary  Tree  Example  3 
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Consider,  for  example,  Figure  31.  Figure  31b  shows  the  state  of  PairedBdrySet  with  respect  to  the 
HCA  after  the  first  pass  through  tlie  inner  loop  ("while  PaiiedBdrySet  is  changing"),  where  each  boundary 
"i  j"  in  the  initial  set  of  boundaries  is  intersected  with  the  two  adjacent  boundaries,  and  the  shortest  version  of 
"i  j"  is  retained  in  PairedBdrySet.  Those  boundaries  which  pair  up  with  an  adjacent  boundary  are  marked  with 
fn  Figure  31b,  "1,6"  pairs  with  "5,6"  and  “1,2"  pairs  with  "2,3".  "4,5"  and  "3,4"  were  not  marked,  and  so 
are  going  to  be  replaced  in  PairedBdrySet  by  the  full  versions  of  their  respective  boundaries  at  the  start  of  the 
next  pass  through  the  inner  loop.  After  the  second  pass  through  the  inner  loop,  all  boundaries  are  marked  as 
in  Figure  3  lc,  so  on  the  next  iteration  no  changes  to  PairedB  dry  Set  will  be  made,  so  the  "while  changing"  con¬ 
dition  will  fail,  ending  the  inner  loop. 

As  the  outer  loop  ("while  BdrySet  is  changing")  finishes  its  first  pass,  new  boundaries  are  generated 
from  each  intersection  point  of  paired  boundaries,  and  these  boundaries  are  placed,  unmarked,  into  Paired¬ 
BdrySet,  which  replaces  BdrySet.  This  situation  is  reflected  in  Figure  3  Id.  Figure  31e  reflects  the  state  of 
PairedBdrySet  after  the  outer  loop  has  started  its  second  pass,  and  the  inner  loop  has  run  until  it  stabilizes 
again.  Note  that  some  boundaries  which  were  paired  after  pass  one,  i.e.,  ”4,5"  and  "3,4",  are  in  fact  intersected 
by  second-level  boundaries  instead,  and  so  the  truncated  versions  of  the  boundaries  need  to  be  retracted  from 
PairedBdrySet  and  the  full  versions  put  back  into  PairedBdrySet  for  further  interaction  with  second-level  boun¬ 
daries.  This  illustrates  why  such  this  procedure  is  complicated,  because  we  are  not  able  to  tell  with  a  single 
pass  which  boundaries  will  be  paired.  Boundary  "1,4"  is  now  propagated  from  both  directions  from  the  inter¬ 
section  points  of  "4,5"  and  "1,5"  as  well  as  "13"  and  "3,4".  It  is  truncated  at  both  ends  and  paired  with  itself, 
after  which  the  configuration  is  stable.  Thus  BdrySet  will  not  change  further,  so  the  outer  loop  will  halt  with 
BdrySet  as  illustrated  in  Figure  31f.  At  each  stage,  the  interior-boundary  trees  are  built  up  until,  in  Figure  31f, 
a  single  tree  results. 

In  algorithm  hca-opm-liigh-ext,  it  is  assumed  initially  that  there  is  an  opposite  point,  i.e.,  a  point  on 
the  hidden  side  of  the  HCA  where  two  optimal  paths  go  in  opposite  directions  around  the  HCA.  Further,  this 
assumed  opposite  point  is  initially  considered  a  vertex  for  the  purposes  of  the  algorithm.  Figure  30  shows  a 
situation  where  the  algorithm  leads  to  the  conclusion  that  (he  opposite  point  does  not  exist  after  all,  and  so 
there  is  no  interior  boundary  incident  to  it,  because  there  is  shortcutting  of  paths  from  the  outside  of  the  HCA 
across  the  HCA  to  the  goal.  The  figure  also  shows  a  situation  where  there  is  more  than  one  interior-boundary 
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tree.  There  is  one  exterior  opposite-edge  boundary  incident  upon  an  HCA  edge  associated  with  each  interior- 
boundary  tree.  It  has  one  endpoint  at  the  point  at  which  a  boundary  of  the  tree  intersects  an  opposite  edge. 

5.  An  Algorithm  tor  OPM  Construction  for  A  Single  Convex  High-Cost,  Interior-Goal 
Homogeneous-Cost  Area 

A  much  different  algorithm  is  needed  to  construct  boundaries  for  the  case  of  a  high-cost  HCA  with 
an  interior  goal  point  (see  Figure  26).  The  existence  of  interior  boundaries  are  more  predictable  without  the 
need  for  the  iterative  checking  as  in  the  high-cost,  exterior-goal  HCA  case.  It  is  still  necessary,  however,  to 
check  the  intersections  of  various  boundaries  and  truncate  them  appropriately,  and  insert  portions  of  edges 
into  the  optimal-path  tree,  which  is  done  at  the  algorithm’s  conclusioa  (See  Table  10.) 

The  algorithm  proceeds  by  looking  at  each  HCA  vertex  in  turn,  and  determining  by  observing  its  op¬ 
timal  path  whether  it  is  a  hidden  or  a  visible  vertex.  If  it  is  a  hidden  vertex,  the  path  from  the  vertex  will  travel 
along  an  edge  of  the  HCA  before  cutting  into  the  interior,  while  if  it  is  a  visible  vertex,  the  path  will  go  direct¬ 
ly  to  the  goal.  If  it  is  hidden,  several  interior  boundaries  and  one  exterior  shadow  boundary  are  generated,  as 
well  as  possibly  an  opposite-edge  boundary.  If  it  is  visible,  only  one  exterior  boundary,  a  visible-edge  bound¬ 
ary,  is  generated. 

It  is  necessary  to  insert  portions  of  edges  into  the  optimal-path  tree  according  to  the  traversal  charac¬ 
teristics  of  optimal  paths  across  or  along  them.  For  example,  it  is  possible  for  a  portion  of  an  edge  from  one 
vertex  to  act  like  a  road,  where  paths  leave  the  HCA  interior  to  travel  along  the  lower-cost  edge,  and  then  cut 
back  in  to  the  HCA  when  nearer  to  the  god.  Thus  the  first  portion  of  the  edge  would  be  the  root  of  a 
homogeneous-behavior  region  characterized  by  paths  crossing  from  the  interior  to  the  exterior  and  travelling 
along  the  edge,  and  the  next  portion  of  the  edge  would  be  the  root  of  another  region  characterized  by  paths 
crossing  from  exterior  to  interior.  All  this  information  is  not  available  when  processing  each  individual  ver¬ 
tex,  however,  so  edges  which  may  become  region  roots  are  stored  temporarily,  and  at  each  step  when  infor¬ 
mation  is  gained  which  could  rule  out  portions  of  edges  as  roots,  that  information  is  stored  as  a  "mask",  which 
is  used  to  mask  out  portions  of  edges.  At  the  conclusion  of  the  algorithm,  these  edges  and  masks  are  processed 
to  determine  exactly  which  portions  of  edges  belong  as  region  roots  in  the  optimal-path  tree.  Also  done  at  the 
conclusion  of  the  algorithm  is  the  intersecting  of  opposite-edge  and  shadow  boundaries  and  plotting  of  new’ 
boundaries  in  the  HCA  exterior,  much  l!ke  in  the  interior  of  a  high-cost,  exterior-goal  HCA. 
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TABLE  10 

HIGH-COST  INTERIOR-GOAL  HCA  OPM  CONSTRUCTION  ALGORITHM 


algorithm  hca-opm-high-int  (algorithm  VI-5) 

input:  Optimal-Path  Tree  with  root  N,  KCA  A  with  u  vertices; 
output:  DCEL  M  and  revised  OPT  N; 
purpose:  construct  an  OPM  for  high-cost,  interior-goal  HCA; 

{ for  i  :=  1  ton 

{ifP*  Goal,  where  OPL(Vi)  =  [P I  OPL(P)]  /*  i.e.,  if  path  from  V  lies  on  edge  £2  of  HCA  */ 

{  /+  with  other  edge  called  Ei ,  an  interior  linear  */ 

E2  :=  edge  containing  ViP;  /*  bdry  and  two  parabolic  bdrys  are  formed,  */ 

Ei  :=  other  edge  incident  to  Vi;  /*  and  an  exterior  shadow  boundary  is  formed.  */ 

B 1  :=  value  returned  by  construct-high-int-hca-bdrj("hidden-edge",Vi); 

B2  :=  value  returned  by  construct-hlgh-int-hca-bdrj("hidden-edge/goal",Vj); 

B3  :=  value  returned  by  construct-high-int-hca-bdry("visible-edge/goal",P); 

B4  :=  value  returned  by  construct-high-int-hca-bdrj("shadow",P); 
add  B4  to  ExtBdrySet; 

intersect  Bj,  B2,  B3  &  add  B  itn,nc  to  IntBdrySet;  I*  they  intersect  at  the  same  point  */ 
if  B2  intersects  Ei  at  some  pt  X 
{ truncate  B2  at  X; 
add  B2tnwc  to  IntBdrySet; 
insert-iiito-opt(N,ViX, "Near-side"); 
add  Ei  and  Mask(Y{X)  to  VisEdgeSet; 

Bs  :=  value  returned  by  construct-high-int-hca-bdry("corner-cutting"X); 
add  Bs  to  ExtBdrySet; 

}  /*  if  paths  from  two  vertices  go  opposite  ways  */ 

else  if  (OPLCVi)  <Z  OPL(Vi+i)  and  OPL(Vi+i)  <2  OPL(Vi))  /♦  around  HCA,  edge  is  opp  edge.  ♦/ 

{Be  :=  value  returned  by  construct-high-int-bca-bdrj("interior-opposite-edge",Vi,Vi+i); 
intersect  B6  with  B2  &  add  B6ln",c  to  IntBdrySet; 

X  :=  pt  where  Be  intersects  Ei; 

B7  :=  value  returned  by  constnKt-high-int-hca-bdrj("exterior-opposite-cdge",Vi,Vi+i); 
add  B7  to  ExtBdrySet; 
insert-into-opt(N,ViX, "Near-side"); 
lnsert-lnto-opt(NpCVi+i, "Near-side"); 

} 

else 

( insert-into-opt(N3l , "Near-side"); 
add  B2t™nc  to  IntBdiySet; 

) 

if  B3  intersects  edge  E2  at  X 

{ insent-lnto-optfN.VjX,' "Near-side"); 

truncate  B3  at  X; 

add  B3<nn>e  to  IntBdrySet; 

) 

) 

else  /*  i.e.,  if  path  goes  from  V  directly  to  GoaL  *1 

{B  :=  value  returned  by  construct-hlgh-int-bca*bdrj<"visible-edge",Vi); 
add  B  to  ExtBdrySet; 
add  Ei  and  E2  to  VisBdrySet; 

) 

post-process-high-int-hca-bdrys; 

)  /*  end  of  bca-opm-high-int  */ 
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HIGH-COST  INTERIOR-GOAL  HCA  OPM  CONSTRUCTION  ALGORITHM 


procedure  construct-high-int-hca-bdry  /*  constructs  each  type  of  bdry  formed  by*/ 

input:  type  of  bdry  T;  P,  the  start-point  of  bdry;  /*  a  higb-cost,  interior-goal  HCA.  */ 

output:  Bdry,  the  resulting  boundary; 

purpose:  to  construct  a  boundary  generated  from  point  P  of  type  T; 

{if  T  =  "hidden-edge"  Bdry  :=  curve  as  specified  in  Lemma  V-5.1; 
if  T  -  "hidden-edge/goal"  Bdry  :=  curve  as  specified  in  Lemma  V-5.2; 
if  T  =  "visible-edge/goal"  Bdry  :=  curve  as  specified  in  Lemma  V-5.3; 
if  T  =  "interior-opposite-edge"  Bdry  :=  curve  as  specified  in  Lemma  V-5.4; 
if  T  =  "hca-edge"  Bdry  :=  curve  as  specified  in  Lemma  V-5.5; 
if  T  =  "shadow"  Bdry  :=  curve  as  specified  in  Lemma  V-5.6; 
if  T  =  "exterior-opposite-edge"  Bdry  :=  curve  as  specified  in  Lemma  V-5.7; 
if  T  =  "comer-cutting"  Bdry  :=  curve  as  specified  in  Lemma  V-5.8; 
if  T  =  "visible-edge"  Bdry  :=  curve  as  specified  in  Lemma  V-5.9; 

}  /*  end  of  constnict-high-int-hca-bdry  */ 


procedure  post-process-high-int-hca-bdrys  /*  store  bdrys  and  edges.  */ 

input:  VisEdgeSei,  the  set  of  bdrys  from  visible  edges,  IntBdrySet,  the  set  of 
interior  bdrys,  ExtBdrySet,  the  set  of  exterior  bdrys,  and  Optimal-Path  Tree  N; 
output:  DCEL  M,  and  revised  OPT  N; 

{for  each  edge  Ee  VisEdgeSet 
{for  all  MaskE  E  :=  E  less  Masks 
N  :=  value  returned  by  insert-into-opt(N,E); 

) 

for  each  bdry  B  6  IntBdrySet 
if  another  version  of  B  exists 
{truncate  B  and  B'; 
insert-into-dcd(M3tninc); 

1 

for  each  bdry  B  €  ExtBdrySet 
join-high-int-bdrys(B,ExtBdiySet); 
for  each  bdry  B  €  ExtBdrySet 
insert-into-dcel(M3); 

}  /*  end  of  post-process-high-int-hca-bdrys  */ 


procedure  join-high-int-bdiys  /*  joins  external  bdrys.  */ 

input:  bdry  B  i,  set  of  bdrys  ExtBdrySet; 
output:  revised  ExtBdrySet; 

purpose:  to  pair  bdrys  which  first  intersect,  and  propagate  new  ones  from  their  pt  of  intersection. 

{ for  each  B2  €  ExtBdrySet  such  that  B 1  and  B2  intersect  and  B 1  and  B2  are  adjacent 
{ truncate  B]  and  B2; 

remove  original  B 1  and  B2  from  ExtBdrySet; 
add  BilfUnc  and  B2(nmc  to  ExtBdrySet 

T  :=  type  of  new  bdry;  /•  based  on  edges  El  and  E2  not  */ 

B3  :=  value  returned  by  I*  common  to  B  s1™110  and  B2trunc.  *1 

coastrnct-hca-opm-high-int-bdry(T,Ei32) 

join-high-int-bdrys(B33xtBdrySet);  /*  recursively  follow  bdry  outward  from  HCA.  *1 


) 

}  I*  end  of  join-hlgh-int-bdrys.  *1 
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6.  An  Algorithm  for  OPM  Construction  for  A  Single  Low-Cost,  Exterior-Goal 
Homogeneous-Cost  Area 

The  exterior-goal-low-cost-region  algorithm  shown  in  Table  11  looks  at  each  HCA  vertex  in  turn, 
basing  its  logic  on  the  initial  direction  of  the  optimal  path  from  the  vertrr.  being  examined  (see  Figure  27).  If 
the  optimal  path  from  a  vertex  goes  into  the  HCA  interior,  two  rays,  or  vertex/edge-crossing  boundaries,  are 
constructed  forming  a  wedge  outward  from  the  vertex  and  away  from  the  goal.  If  the  optimal  path  goes  along 
an  edge  of  the  HCA,  one  of  the  above  boundaries,  the  one  closer  to  the  direction  of  travel  of  the  optimal  path, 
is  instead  a  vertex/edge-following  boundary,  and  in  addition  a  parabolic,  or  vertex/goal  boundary  is  con¬ 
structed.  The  third  possibility  is  that  the  optimal  path  goes  directly  into  the  HCA  exterior,  i.e.,  toward  the  goal. 
If  so,  more  boundaries  may  or  may  not  be  generated.  If  a  portion  of  each  edge  adjacent  to  the  vertex  is  visible 
to  the  goal,  i.e.,  if  for  both  edges  there  are  paths  starting  at  some  points  on  the  edges  which  go  directly  into  the 
HCA  exterior,  then  a  visible-edge  boundary  will  emanate  from  the  vertex  into  the  HCA  interior. 

With  the  above  boundaries  generated,  two  tasks  remain.  First,  each  parabolic,  oredge-following/goal 
boundary  must  be  followed  away  from  the  goal  to  see  if  it  intersects  the  next  ray  boundary.  If  so,  a  hyperbolic, 
or  vertex/goal  boundary  will  begin,  with  ooe  focus  at  the  vertex.  This  hyperbola  must  then  be  followed  in  turn. 
If  it  intersects  a  ray  boundary,  a  "distorted-parabolic",  or  edge-crossing/goal  boundary  will  begin.  As  we  con¬ 
tinue  to  follow  this  sequence  of  boundaries,  hyperbolas  and  distorted-parabolas  occur  alternately  uutil  no  in¬ 
tersection  with  a  ray  is  found.  Note  that  this  algorithm  generates  each  parabolic  and  distorted-parabolic 
boundary  in  the  initial  phase,  and  then  generates  hyperbolas  as  needed  <n  procedure  add-hyp-bdrys-for-Iow- 
ext-bca  below,  which  in  addition  truncates  each  boundary  as  necessary. 

Although  this  type  of  HCA  has  interior  boundaries,  which  one  might  suppose  would  need  to  be  paired 
and  merged  as  with  the  high-cost,  exterior-goal  case,  in  fact  it  is  not  necessary  to  do  this.  The  reason  is  that 
such  boundaries  are  all  of  the  visible-edge  type,  and  because  the  HCA  interior  is  of  lower  cost  than  the  sur¬ 
rounding  terrain,  these  boundaries  will  never  intersect  Intuitively  in  the  high-cost  exterior-goal  case,  a  path 
travels  to  an  edge  further  away  in  straight-line  distance  in  order  to  take  advantage  of  the  lower  external  cost 
outside  that  edge,  and  at  that  point,  two  boundaries  would  intersect  and  a  third  emerge.  Here,  however,  the 
path  is  already  in  the  least  costly  terrain  possible,  ai  d  so  further  paths  will  continue  to  follow  the  same  paths 
as  those  closer  to  the  goal.  For  each  visible-edge  boundary,  a  point  of  intersection  is  plotted  with  the  far  edge 
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TABLE  11 


LOW-COST  EXTERIOR-GOAL  HCA  OPM  CONSTRUCTION  ALGORITHM 


algorithm  hca-opm-low-ext  (algorithm  VI-6) 

input:  Optimal-Path  Tree  with  root  N,  and  HCA  A; 
output:  Optimal-Path  Map  M  (a  DCEL)  and  modified  Optimal-Path  Tree  N; 
purpose:  construct  an  OPM  for  a  low-cost,  exterior-goal  HCA; 

{ 

for  each  vertex  V  of  A  with  incident  edges  E|  and  E2  /♦  consider  each  vertex  and  its  adjacent  edges  *1 
such  that  Et  =  W 1  and  E2  =  VV 2,  where  I V2GI  l>  /*  where  V 1  is  closer  to  goal  than  V2,  and  */ 

IV iGl  and  OPL(V)  =  [?  I  OPL(P)]  /*  where  P  is  the  first  point  on  V’s  opt  path.  */ 

i 

if  VP  lies  in  HCA  interior  /*  if  optimal  path  from  V  goes  into  HCA  interior  */ 

{ 

const  nict-low-ext-hca-bdryfvertex/ 

edge-crossing, V,V t,V2);  I*  two  rays  are  Snell’s-Law  pntiis  across  */ 

construct-Iow-ext-hca-b  dr y(vertex/  /♦  edges  Et  and  E2  through  vertex  V  */ 

edge-crossing,  V.V2.V  1); 

lnsert-into-opt(N,VVi  ,Far-side);  /♦  add  edges  to  OPT  as  region  roots.  */ 

insert-into-opt(N,VV2,Far-side); 

} 

else  if  VP  lies  along  HCA  edge  Ei  /*  if  opt.  path  from  V  goes  along  an  HCA  edge  */ 

I 

constrnct-low-ext-hca-bdry(edge-following/ 

goal,V,V|,V2); 

con  st  ruct-k)w-<xt-hca-bdry(vertex/ 

edge-following,V,Vi,V2);  /*  two  rays  are  Snell’s-Law  paths  across  *1 

constniri-low-ext-hca-bdryfvertex/  /*  edges  Ei  and  E2  through  vertex  V  */ 

edge-crossing,  V.V2.V  1); 

insert-into-opt(N,VP .Near-side);  /*  add  edges  to  OFT  as  region  roots.  */ 

insert-hit  o-opt(N,W2  Far-side); 

I 

else  if((Qt  is  in  HCA  exterior)  or  (ViQie  VtV))  /*  if  both  edges  are  visible  or  partially  visible  */ 
and  ((Q2  is  in  HCA.  exterior)  or  (ViQie  V2V)))  /*  (optimal  path  from  V  lies  in  HCA  exterior).  */ 
where  OPL(V  1)  =  [Qi  I  OPL(Qi)]  /*  Note:  Qi  are  the  first  points  on  */ 

and  0PL(V2)  =  [Q2 1 0PL(Q2)J  /*  the  optimal-path  lists  of  each  Vi  */ 

1 

constract-low-ext-hca-bdr7(visible-edge,  /*  vis-edge  bdry  from  V  w.r.t  Et  and  E2  */ 
V,Vi,V2); 
for  i  :*  1  to  2 

if(ViQte  VtV)  /*  add  as  region  root  the  portion  of*/ 

insert-into-opt(N,  QtV,  Far-side);  /*  edge  across  which  paths  cross.  */ 

else  insert-into-opt(N,  V|V,  Far-side); 

} 

) 

add-hyp-bdrys-for-low-ext-hca(ParabBdrys); 

)  /*  end  of  algorithm  bca-opm-low-ext  V 
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TABLE  11  (CONTINUED) 

LOW-COST  EXTERIOR-GOAL  HCA  OPM  CONSTRUCTION  ALGORITHM 


procedure  add-hyp-bdrys-for-lew-ext-hca;  /*  puts  hyperbolas  between  pairs  of  ray  bdrys  */ 

input:  ParabBdrys,  the  set  of  parabolic  boundaries; 
output:  revised  DCEL; 

purpose:  to  concatenate  hyperbolic  bdrys  onto  parabolic  ones. 

( 

while  ParabBdrys  *=  0 

{ 

select  bdry  B  je  ParabBdrys  associated  with  vertex  Vi  and  edge  Ej ; 
truncate  B  t  and  the  vertex/edge-following  or  vertex/edge-crossing  bdry  Bj  emanating 
from  Vi,  and  associated  with  edge  Ej  at  the  point  whore  they  intersect; 

B<  :=  value  returned  by  construct-low-  /*  bdry  is  hyperbola  intersecting  one  or  */ 

ext-hca-bdry(vertex/goal,Vi,Vj,Vic);  /*  both  rays  emanating  from  vertex  Vi  */ 

if  B<  intersects  vertex/edge-crossing  bdry 
B3  associated  with  Vi  and  edge  Ek,  k^j, 

{ 

truncate  Ba  and  Ba  at  their  point  of  intersection; 

truncate  Bse  ParabBdrys  assoc,  with  Vg  and  Ek.  g^i,  at  its  intersection  with  B3  and  B4 ; 

) 

remove  B|  from  ParabBdrys; 

)  I*  end  add-hyp-bdrys-for-Iow-ext-hca  */ 


of  the  HCA,  and  an  opposite-edge  boundary  is  generated,  which  is  really  just  a  continuation  of  the  visible- 
edge  boundary  after  crossing  another  edge. 

Procedure  construcMow-ext-bca-bdry  performs  the  low-level  function  of  generating  each  bound¬ 
ary  for  the  low-cost,  exterior-goal  HCA  as  needed.  For  boundaries  whose  forms  are  general  curves,  the  reader 
is  referred  to  the  appropriate  Lemma  in  Chapter  V  and  proof  in  Appendix  A. 

7.  An  Algorithm  for  OPM  Construction  for  A  Single  Low-Cost,  Interior-Goal 
Homogeneous-Cost  Area 

Algorithm  bca-opm-low-int  is  the  simplest  of  the  four  HCA  algorithms,  in  keeping  with  the  simple 
nature  of  the  regions  and  boundaries  associated  with  this  type  of  HCA  (see  Figure  28  and  Table  12).  Since  a 
low-cost,  interior-goal  HCA  generates  only  one  wedge  of  two  rays  at  each  vertex,  and  these  rays  are  guaran¬ 
teed  by  the  orientation  of  the  HCA  edges  not  to  interact,  the  corresponding  algorithm  can  do  its  work  in  one 
pass  through  the  list  of  vertices. 
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TABLE  12 


LOW-COST  INTEPJOR-GOAL  HCA  OPM  CONSTRUCTION  ALGORITHM 


algorithm  bca-opm-low-int  (algorithm  VI-7) 

input:  Optimal-Path  Tree  with  root  N,  and  HCA  A; 
output:  Optimal-Path  Map  M  (a  DCEL)  and  modified  Optimal-Path  Tree  N; 
purpose:  to  construct  the  OPM  for  a  low-cost.,  interior-goal  HCA; 


l 

M  :=  empty  dee!  structure; 
for  each  edge  Vs  V2  of  A 

l 

Bdryt  :=  ray  starling  at  Vj,  lying  away 
from  Goal  G  thru  pt  X],  such  that 
ZGViV2=  JC/2-01,  ZX1V1V2  ~  71/2+02  , 

andcinisinBi  =  Cextsin  62; 

Bdry2  :=  ray  starting  at  V2,  lying  away 
from  Goal  G  thru  pt  X2,  such  that 
ZGV2V|=  7t/2-0i,  ZX2V2V1  =  7C/2+02 , 

and  csnisinBi  =  c-xtsin  02 ; 
insert-kito-dcdfM^Bdryi); 
hMert-into-dcd(MJBdry2); 
ins*rt-Snto-<kd(M,V  1V2); 
insert-into-optfN.edge  ViV2jFaj-side); 

) 

1 


/*  two  bdrys  emanate  from  each  vertex,  */ 
/*  at  the  Snell’s-Law  angle  with  respect  */ 
/*  to  each  edge.  */ 


/*  add  vertex/edge-crossing  bdrys  to  DCEL.*/ 

/*  add  HCA-edge  boundary  to  DCEL  */ 

/*  add  edge  which  is  crossed  to  OPT.  */ 

/*  end  of  bca-opm-low-int  */ 


C.  EXTENDING  THE  BaSIC  ALGORITHMS  TO  MULTIPLE  CONNECTED  RIVER  AND 
ROAD  SEGMENTS 

1.  An  Algorithm  for  OPM  Construction  for  Multiple  Connected  River  Segments 

It  is  now  possible  to  build  on  a  basic  understanding  of  the  nature  of  boundaries  generated  by  single, 
isolated  river  segments  in  order  to  construct  the  boundaries  associated  with  multiple,  connected  linear  river 
segments,  or  rivers.  There  may  be  two  or  more  river  segments  emanating  from  a  single  vertex,  but  all  seg¬ 
ments  of  a  river  must  have  the  same  crossing  cost  It  might  be  thought  that  the  algorithm  proposed  below  to 
construct  the  optimal-pith  m>|>  for  multiple  terrain  features  could  be  used  to  construct  it  for  this  of  ter¬ 
rain  as  well.  However,  connected  river  segments  are  not  "decomposable"  into  their  constituent  segments. 
Decomposability  of  a  set  of  terrain  features  is  defined  as  follows. 
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Terrain  map  M  with  optimal-path  tree  N  is  defined  as  decomposable  for  path  planning  into  subsets 
S  t  and  S2  if  both  S  i  and  S2  are  consistent  with  OPT  N.  Say  that  a  set  of  terrain  St  which  is  a  subset 
of  a  set  of  terrain  S  is  consistent  with  an  OPT  N  constructed  for  S  if  for  an  OFT  Ni  constructed  for 
Si  considered  alone,  every  node  of  Ni  appears  in  N,  and  the  parent  of  every  node  of  Ni  appears  in 
the  path  from  the  node  to  the  root  of  N. 

In  other  words,  if  one  subset  could  not  behave  in  the  way  it  does  without  the  presence  of  the  other, 
the  terrain  is  not  decomposable.  Connected  river  segments  have  as  part  of  their  nature  that  at  internal  vertices, 
i.e.,  where  two  segments  join,  there  are  regions  where  paths  must  either  cross  a  river  or  move  away  from  the 
vertex,  while  for  the  individual  segments,  a  path  could  bypass  the  river  segment  by  simply  moving  around  the 
vertex.  Thus  a  set  of  connected  river  segments  is  not  decomposable  into  its  individual  segments. 

Two  high-level  paradigms  in  addition  to  those  used  for  single  river  segments  are  useful  here.  First, 
we  partially  sort  the  river  segments  according  to  their  general  visibility  to  the  goal,  i.e.,  so  that  a  segment  which 
is  fully  or  partially  occluded  by  another  follows  it  in  the  partial  order,  and  we  process  the  segments  according 
to  this  partial  order.  Thus  boundaries  which  may  affect  other  segments  are  already  in  place  by  the  time  the 
other  segments  are  considered.  Second,  whenever  a  boundary  intersects  an  occluded  segment,  an  event  point 
is  generated.  When  a  segment  is  processed,  it  is  necessary  to  consider  each  event  point  and  decide  whether  the 
boundary  wliich  caused  the  event  point  continues  oa  the  other  side  of  the  river  segment.  Figure  33  shews  a 
river  consisting  of  connected  river  segments,  and  figure  34  shows  a  wont-case  orientation  of  segments. 

Several  new  terms  must  be  defined.  General  visibility  between  two  terrain  features  is  defined  as  fol¬ 
lows.  Two  features  F[  and  Fn  are  generally  visible  with  respect  to  a  goal  G  if  there  is  a  sequence  of  features 
Ft,  i=I  to  e,  such  that  for  all  i,  F|  is  visible  to  F1+1.  A  feature  Fj  is  occluded  by  another  Fj  with  respect  to  goal 
G  if  for  every  sequence  by  which  Fi  and  G  are  generally  visible,  Fjiia  member  of  the  sequence.  In  other  words, 
Fi  is  occluded  by  Fj  if  it  is  partially  or  completely  within  the  shadow  of  Fj  cast  by  G.  An  endpoint  V  of  line 
segment  La  is  defined  as  an  exterior  vertex  if  V  is  not  an  endpoint  of  any  other  line  segment,  or  if  segment  L2 
of  which  V  is  an  endpoint  occludes  L|.  V  is  defined  as  an  interior  vertex  if  it  is  not  an  exterior  vertex.  Intui¬ 
tively  this  means  that  an  optimal  path  from  an  interior  vertex  must  either  cross  the  river  or  move  away  from 
the  vertex  to  get  past  the  line  segment,  while  from  an  exterior  vertex  an  optimal  path  can  simply  move  around 
the  vertex  and  bypass  the  river,  figure  33  shows  the  partial  ordering  of  river  segments  as  well  as  the  exterior 
or  interior  nature  of  each  vertex. 
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Figure  33 

Multiple- Connected  River  Segments 
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\ 


Figure  34 

Worst-Case  Complexity  of  Multiple  Connected  River  Segments 
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The  algorithm  based  on  these  ideas  is  complicated  by  the  possibility  that  rivers  may  turn  back  on 
themselves  and  create  pockets  where,  for  a  high-enough  crossing  cost,  it  is  cost-effective  to  move  away  from 
the  goal  out  of  the  pockets  rather  than  cross  a  river.  This  situation  is  illustrated  in  Figure  33a,  in  the  vicinity 
of  vertices  8  through  1 1 .  A  type  of  boundary  in  addition  to  those  presented  in  Chapter  V  for  single  river  seg¬ 
ments  is  generated  in  this  case,  although  it  is  very  similar  to  the  other  types.  Whenever  an  exterior  vertex  V t 
is  encountered  in  the  course  of  processing  river  segments,  a  river-crossing  boundary  is  generated  for  that  ver¬ 
tex,  as  explained  in  Chapter  V.  If  this  boundary  does  not  intersect  any  segment  between  V i  and  V2,  all  paths 
from  immediately  on  the  far  side  of  the  river  including  the  path  from  V2  will  go  via  Vi.  In  this  situation  there 
will  be  a  boundary  which  separates  paths  which  cross  a  river  toward  the  goal  from  those  which  move  away 
from  the  goal  and  eventually  go  through  V2  and  then  through  V  j.  At  each  interior  vertex,  as  well  as  at  the  next 
exterior  vertex,  a  portion  of  this  boundary  will  be  generated.  This  type  of  boundary  is  called  a  near-side-river¬ 
crossing  boundary  and  it  is  exactly  the  complement  of  the  river-crossing  boundary  which  would  be  generated 
from  that  vertex  if  an  optimal  path  from  the  vertex  lay  forward  across  the  river.  In  other  words,  it  starts  at  the 
current  river  segment  and  lies  forward  toward  the  goal. 

An  example  of  a  near-side-river-aossing  boundary  in  Figure  33  has  one  end-point  on  segment  (8,9). 
From  there,  it  lies  toward  the  goal  until  it  intersects  a  shadow  boundary  which  starts  at  vertex  9.  The  next  por¬ 
tion  of  the  boundary  is  the  hyperbola  segment  whose  axis  is  the  line  between  vertices  10  and  4.  After  it  inter¬ 
sects  the  shadow  boundary  from  vertex  10,  the  boundary  is  the  hyperbola  segment  whose  axis  is  the  line 
between  vertices  1 1  and  4.  Finally,  it  ends  at  the  point  where  it  intersects  a  river-crossing  boundary  separat¬ 
ing  points  whose  paths  go  around  vertex  5  from  those  whose  paths  cross  segment  (7,8).  From  there  an  op¬ 
posite-edge  boundary  begins,  separating  points  whose  paths  go  around  vertex  5  from  those  which  go  around 
vertex  1 1.  A  second  example  of  a  near-side-river-  crossing  boundary  is  in  the  vicinity  of  vertex  1. 

At  each  interior  vertex  V,  the  test  for  a  near-side-river-crossing  boundary  is  as  follows.  If  for  a  point 
arbitrarily  close  to  V,  but  on  the  nearside  of  the  river,  called  V,  the  optimal-path  list  of  V*  includes  Ve.-.t,  the 
currently  active  exterior  vertex,  a  near-side-river-crossing  boundary  is  generated.  The  foci  are  V  and  the  ver¬ 
tex  or  goal  point  X  such  that  the  cost  of  a  straight-Iins  path  from  V  to  X  plus  the  cost  of  the  optimal  path  from 
X  is  minimized,  and  the  hyperbolic  constant  is  the  cost  of  the  optimal  path  from  V  minus  the  sum  of  the  cost 
of  the  rivers  crossed  from  V  to  X  and  the  cost  of  the  optimal  path  from  X.  In  this  case,  the  shadow  boundary 
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from  V  may  intersect  the  boundary  at  a  point  P.  The  boundary  starts  at  its  intersection  with  the  current  river 
segment,  or  if  it  is  the  second  or  subsequent  portion  of  the  boundary  to  be  generated,  at  its  intersection  with 
the  previous  boundary  portion,  and  ends  at  point  P.  If  the  boundary  intersects  the  river-crossing  boundary 
generated  by  Vext,  it  ends  at  that  point  and  the  Vext  boundary  constitutes  the  remainder  of  the  boundary. 

Shadow  boundaries  follow  the  same  specifications  as  listed  in  Chapter  V,  namely  that  a  vertex  V, 
with  an  optimal  path  which  goes  first  to  point  P,  generates  a  shadow  boundary  which  is  a  ray  starting  at  V  and 
lying  away  from  P  on  the  line  VP,  but  with  the  variation  that  it  must  be  considered  whether  the  optimal  path 
of  V  crosses  the  river  segment  or  not.  If  for  V  as  defined  above,  and  for  V*  arbitrarily  close  to  V  on  the  far 
side  of  the  river  segment,  V*  can  be  positioned  so  as  to  lie  on  the  optimal  path  of  V+,  a  normal  shadow  bound¬ 
ary  results.  This  is  the  case  where  paths  from  the  far  side  of  the  river  may  cross  in  the  vicinity  of  V,  and  such 
a  boundary  simply  keeps  track  of  which  segment  the  paths  cross. 

If  V  includes  in  its  optimal  path  the  current  Vext,  it  will  be  the  case  that  V*  does  so  as  well,  and  the 
shadow  boundary  which  results  will  conform  to  the  above  specification  with  respect  to  V  and  will  have  the 
unusual  characteristic  that  it  lies  on  the  near  side  of  the  river  segment  This  is  the  case  where  points  on  the  near 
side  of  V  are  caught  in  a  "pocket"  for  which  it  is  faster  to  move  away  from  the  goal  and  around  Vext  than  to 
cross  river  segments  forward  of  V.  Such  a  shadow  boundary  separates  points  which  go  to  V  and  then  to  the 
vertex  on  the  next  river  segment  from  those  which  bypass  V  and  go  to  the  next  vertex  directly. 

If  V+  includes  in  its  optimal  path  the  current  Vext,  but  V  does  not,  the  shadow  boundary  from  V  will 
be  formed  with  respect  to  V+,  and  lie  on  the  far  side  of  the  river.  This  is  the  case  where  the  optimal  path  of  V 
lies  on  the  same  side  of  the  river  segment  as  does  the  optimal  path  of  Vext.  but  the  optimal  path  of  V+  includes 
Vext,  signifying  that  paths  on  the  far  side  of  the  river  in  the  vicinity  of  V  will  not  cross  it,  but  paths  on  the  near 
side  will  lie  generally  toward  the  goal,  not  being  caught  in  a  "pocket"  which  causes  them  to  move  away  from 
the  goal  to  avoid  crossing  subsequent  river  segments.  Table  13  shows  the  algorithm  for  construction  of  mul¬ 
tiple  connected  river  segments. 
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TABLE  13 


MULTIPLE-CONNECTED-RIVER-SEGMENT  OPM  CONSTRUCTION 

ALGORITHM 


algorithm  multi-segment-river-opm  (algorithm  VI-8) 

input:  List  of  river  segments  R,  river-crossing  cost  Cr,  Optimal-Path  Tiee  N,  Goal  G; 
output:  DCEL  M  and  revised  OPT  N; 

purpose:  construct  a  planar  partition  and  revise  the  OPT  for  multiple,  connected  river  segments; 
(partially  order  R  so  that  Si  <  Sj  iff  Si  obscures  part  of  Sj  with  respect  to  G; 
for  each  segment  S  €  R  in  partial  order,  letting  S  =  V 1 V2  where  V 1  is  closer  to  G  than  is  V2 
(plot  shadow  bdry  from  Vt; 
plot  shadow  bdry  from  V2; 

intersect  bdrys  with  all  subsequent  segments,  noting  an  event-point  whenever  intersection  occurs; 
if  Vt  is  "exterior" 

(Vext  :=  Vi; 

sort  event-pts  on  V 1V2  with  respect  to  Vt, 
including  V2  as  an  event-point; 
until  a  river-crossing  bdry  is  plotted  for  V 1 
or  event-list  is  empty 
(select  next  event-point  E; 

Et  :=  root  of  region  on  side  of  E  closer  to  V  t; 

CVexi  :=  lEVextl  +  l(VexlG)*l; 

C&  :=  lEEfl  +  l(ErG)*l; 
if  CVext  >  C& 

plot  river-crossing  bdry  with  respect  to  Vext  and  Efj 
else 

delete  portion  of  bdry  Be  lying  away  from  Goal; 

J 

} 

else 

do  nothing;  /*  If  Vi  is  "interior".  */ 

if  V2  is  "interior" 

( V2'  :=  point  arbitrarily  close  to  V2  on  same  side  of  river 
as  first  leg  of  optimal  path  from  Vext! 

V2+  :=  point  arbitrarily  close  to  V2  on  opposite  side  of  river 
as  first  leg  of  optimal  path  from  Vext; 
if  Vext  €  (V2'G>*  and  Vext  S  (V2+G)* 

(plot  shadow  bdry  Bi  such  that  for  0PL(V2'G)*  =  [P I  OPL(P)], 

Bi  :=ray  on  line  V2P  starting  at  V2,  lying  away  from  P; 


X  :=  vertex  or  goal  such  that 
IV2XI  +  l(XG)*l  is  minimized; 
plot  B2  :=  near-side-crossing  bdry  with 
foci  V2  and  X,  where  B2  starts  at  point  of 
intersection  with  line  V |V2  and  end3  at 


/*  ie,  vertex  with  best  cost  from  Y2  to  X  to  Goal,  *1 
/♦  with  hyp  cost  :=  Cr-no.  rivers  crossed  by  V2X.  */ 
I*  note  that  if  intersection  is  beyond  V  t,  there  is  */ 
/*  another  near-side-crossing  bdry  wliich  */ 

/♦  intersects  B2.  */ 


ebeifP’s  P*.  where  OP^l  =  [F I  OPL(P*)j  and  OPLCVt4)  =  [P+ 1  OPLfP*)] 
plot  shadow  bdry  on  line  V2P+  starting  at  V2  lying  away  from  P+; 

} 
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TABLE  13  (CONTINUED) 

MULTIPLE-CONNECTED-RIVER-SEGMENT  OPM  CONSTRUCTION 

ALGORITHM 


else  I*  V2  is  "exterior".  ♦/ 

ifVex,  e  (VfG)*  and  Vex,  €  (Vi+G)*  /*  if V2  is  "hidden".  *1 

{plot  shadow  bdry  Bj  such  that  for  OPL(V t'G)*  =  [P I  OPL(P)], 

Bi  :=  ray  on  line  V iP  starting  at  Vi,  lying  away  from  P; 


X  :=  vertex  or  goal  such  that 
IViXI  +  l(XG)*l  is  minimized; 
plot  B2  :=  near-side-crossing  bdry  with 
foci  Vi  and  X,  where  B2  starts  at  point  of 
intersection  with  line  V 1V2  and  ends  at 
intersection  with  Bi; 

) 

else 


/*  te,  vertex  with  best  cost  from  V)  to  X  to  Goal,  */ 
I*  with  hyp  cost  :=  Cr-no.  rivers  crossed  by  V2X.  */ 
I*  note  that  if  intersection  is  beyond  V2,  there  is  */ 
I*  another  near-side-crossing  bdry  which  */ 

/*  will  intersect  B2.  *1 


/*  V2  is  "visible".*/ 


{Vex,  :=V2; 

sort  event-pts  on  V1V2  with  respect  to  V2, 
including  Vi  as  an  event-point; 
until  a  river-crossing  bdry  is  plotted  for  V2 
or  event-list  is  empty 
{select  next  event-point  E; 

Er  :=  root  of  region  on  side  of  E  closer  to  V2; 

CVext  :*  lEVexli  +  l(VexiG)*l; 

C&  :=  lEEd  +  l(EfG)*l; 

if  CVext  >CEr 

plot  river-crossing  bdry  with  respect  to  Vext  and  Er; 
else 

delete  portion  of  bdry  Be  lying  away  from  Goal; 

) 

join  and  merge  bdrys  associated  with  VtV2,  noting  all 
intersections  with  obscured  segments  as  event-points. 

}  I*  end  of  "for  each  segment".  */ 

join  and  merge  all  bdrys; 

)  /*  end  of  algorithm  multi-segment-river-opm.  */ 


2.  OPM  Construction  of  Multiple  Connected  Road  Segments 

Unlike  connected  river  segments,  connected  road  segments  are  decomposable  into  their  constituent  seg¬ 
ments.  The  basic  reason  for  this  is  that  road  segments  will  not  serve  to  block  or  hinder  paths,  but  only  to  operate 
as  conduits.  Therefore,  connected  road  segments  can  be  decomposed  into  individual  segments  by  algorithm 
VI-9  below,  algorithm  VI-3  used  on  each  segment,  and  the  resulting  OPM’s  merged  into  a  final  OPM.  * 
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D.  A  DIVIDE- AND-CONQUER  ALGORITHM  FOR  MULTIPLE-FEATURE  OPM 
CONSTRUCTION 

A  principal  goal  of  our  research  is  to  rind  an  algorithm  which  will  create  optimal-path  maps  for  multiple 
terrain  features  of  the  four  types  described  above.  Although  the  investigation  into  this  problem  is  not  complete 
in  all  its  details,  we  propose  the  following  high-level  description  of  such  an  algorithm  (see  Table  14). 

Methods  for  constructing  Voronoi  diagrams  (see  Chapter  II)  provide  a  model  for  approaches  to  the  con¬ 
struction  of  an  optimal  path  map  for  multiple  terrain  features.  Voronoi  diagram  methods  use  a  divide-and-con- 
quer  approach,  in  which  the  points  in  the  plane  are  divided  into  two  roughly  equal  sets,  the  Voronoi  diagrams 
of  the  two  sets  computed  recursively,  and  the  two  Voronoi  diagrams  merged  to  produce  the  final  one.  The  first 
key  question  is  how  to  divide  the  points  in  the  plane.  The  answer  in  this  case  is  that  in  order  to  support  the 
merge  phase,  the  plane  is  partitioned  into  two  half-planes  by  a  line  (by  convention,  a  vertical  line)  which  equal¬ 
ly  divides  the  set  of  points  in  the  plane.  The  other  key  question  is  whether  the  two  intermediate  Voronoi 
diagrams  can  be  merged.  Standard  generalized-Voronoi-diagram  construction  algorithms  provide  an  affirm¬ 
ative  answer  to  this  question,  depending  on  the  fact  that  the  boundary  between  any  two  Voronoi  regions  in  bi¬ 
nary  terrain  (i.e.,  obstacles  on  a  homogeneous-cost  background)  is  a  straight  line  segment  or  a  hyperbola 
segment  [Ref.  8]. 

The  analogous  questions  with  respect  to  optimal-path  map  construction  are  whether  terrain  features  can 
be  divided  in  the  same  manner  as  points,  and  bow  two  optimal-path  maps  with  the  same  goal  can  be  merged 
into  a  single,  combined  OPM.  An  encouraging  aspect  of  this  problem  is  that  when  constructing  OPM’s  for 
single  terrain  features,  we  rely  on  the  optimal  paths  from  only  the  terrain-feature  vertices,  which  are  computed 
by  standard  point-to-point  path  planners  and  lake  all  the  features  of  a  map  into  account  Thus  the  optimal  paths 
from  any  vertex  will  remain  the  same  regardless  of  which  terrain  features  are  incorporated  into  the  OPM. 
Another  important  aspect  of  this  problem  is  the  unifying  perspective  with  regard  to  regions  and  boundaries 
proposed  in  Chapter  V,  Section  C.  Since  there  are  only  three  types  of  non-degenerate  region  roots,  i.e.,  points, 
edges  traversed  length-wise, aw^  edges  traversed  cross- wise  (according  to  Snell’s  Law),  it  should  be-  possible- 
at  the  intersection  of  any  two  general  boundaries  to  generate  a  new  boundary  by  considering  the  six  types  of 
boundaries  between  regions  of  three  possible  types  of  roots.  Actually,  as  discussed  in  Chapter  V,  the  Snell ’s- 
Law  edges  do  not  comprise  a  single  class  of  region  roots,  because  edges  with  different  numbers  of  edge-cross- 
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TABLE  14 


MULTIPLE-FEATURE  OPM  CONSTRUCTION  ALGORITHM 


algorithm  multiple-feature-opm  (algorithm  VI-9) 

input:  L  a  listing  of  lists  of  vertices  and  types  of  each  terrain  feature,  and 
N,  the  optimal-path  tree  associated  with  Map; 

output:  M,  a  DCEL  describing  the  planar  partition  of  OPM  associated  with  Map,  revised  OPT  N; 
purpose:  to  construct  an  optimal-path  map  for  input  map  consisting  of  any  number  of  terrain  features; 

{ 

if  Map  contains  only  one  terrain  feature  /*  base  case  of  the  recursion.  */ 

OPM  :=  appropriate  single-feature  algorithm; 
else 

I 

(Seti,Set2)  :=  value  returned  by  haive-map;  /*  divide  map  into  two  roughly  equal  sub-maps.  */ 
N|  :=  N  less  region  roots  associated  with  Set2I 
N2  :=  N  less  region  roots  associated  with  Sett; 

OPMi  :=  value  returned  by  multiple-feature-opm(Seti,  Ni );/*  recursively  solve  each  sub-problem.  */ 
OPM2  :=  value  returned  by  multiple-featu re-op m(Set2,  Ni); 

OPM  :=  result  of  merge-opmsfOPM  1 ,0PM2,N  1^2)  I*  find  OPM  by  merging  two  sub-OPM’s.  */ 

) 

}  /■*  end  of  multiple-feature-opm.  *1 


procedure  halve-map 

input:  Map,  tlie  list  of  lists  of  terrain-feature  vertices  and  types; 

output:  a  pair  of  sets  such  that  the  fust  is  the  left  half  of  the  map  and  the  second  is  the  right  half; 
purpose:  divide  Map  into  two  roughly  equal-sized  sub-maps; 

{ 

for  each  decomposable  terrain  feature 
find  the  left-most  vertex; 
compute  the  median  x-coordinate; 
for  each  terrain  feature  F 
if  its  left-most  vertex  is  less  than  the  median 
Seti  :=*  SettU{F); 
else 

Set2  :=  Set2U{F); 

)  /*  end  of  halve- map.  */ 
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TABLE  14  (CONTINUED) 

MULTIPLE-FEATURE  OPM  CONSTRUCTION  ALGORITHM 


procedure  merge-opms 

input:  OPMi  and  OPM2,  DCEL’s  of  the  two  input  OPM’s; 

output:  OPM,  the  DCEL  containing  the  planar  partition  of  the  merged  map; 

OPT  N,  the  revised  optimal-path  tree; 
purpose:  merge  two  OPM’s  into  one; 

{<J  :=  vertical  chain  such  that  all  terrain  features  of  OPMi  are  entirely 
to  its  left  and  all  terrain  features  of  OPM2  are  to  its  right; 

BdrySet  :=  Set  of  all  B  such  that  Be  OPMi  or  Be  OPM2  and  B  intersects  <J; 
while  BdrySet  is  changing 
(PairedBdrySet  :=  BdrySet; 
while  PairedBdrySet  is  changing 

(for  all  Bije  PairedBdrySet  /*  where  h,  i,  j,  and  k  index  the  regions  of  OPM.  ♦/ 

where  Bi,j  is  unmarked 
(discard  By  from  PairedBdrySet; 
add  Bi.j  from  BdrySet  to  PairedBdrySet; 
intersect  By  with  Bh.i  and  truncate  both; 
add  Bh.i'^and  ByUunc  to  PairedBdrySet; 
intersect  By  with  B:,k  andtruncate  both; 
add  By‘n,DC  and  Bj.if’10'  :=  to  PairedBdrySet; 

} 

for  all  Bye  PairedBdrySet 
discard  all  but  the  shortest  By  from  PairedBdrySet; 
unmade  all  bdrys  in  PairedBdrySet; 
for  all  By  and  Bj^e  PairedBdrySet  such  that  By  adjoins  Bj,k 
markBy  andBj.k; 

} 

for  all  Byand  Bj,ic6  PairedBdrySot  such  that  By  adjoins  Bj,k 
add  Bi.kto  PairedBdrySet; 

BdrySet  :=  PairedBdrySet; 

} 

for  each  new  B'  e  BdrySet 

(intersect-and-merge(B',  (all  bdrys  from  OPMi  assoc  with  Rj }); 
intersect-and-merge(B',  (all  bdrys  from  OPM2  assoc  with  R2}); 

I 

1  /*  end  of  merge-opms.  */ 

procedure  intersect-and-merge 

input:  B,  a  new  boundary,  and  BdrySet,  a  set  bdrys  potentially  intersecting  B; 
output:  revised  DCEL  M; 

purpose:  propagate  the  effects  of  new  boundary  B  in  one  of  the  subordinate  OPM’s; 

(for  each  bdry  B'  e  BdrySet 
if  B  intersects  B; 

( truncate  B  and  B'at  their  point  of  intersection; 

find  regions  Rj  and  Rj  which  are  adjacent  to  B  and  B'respectively,  but  not  common  to  both;  , 
construct  Bnc*  by  referring  to  the  roots  of  R|  and  Rj  respectively; 
for  each  boundary  B^in  BdrySet  which  B'previously  intersected 
inter scct-and-mergefB",  BdrySet  less  B'); 

} 

}  /*  end  of  intersect-and-merge.  */ 
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ing  episodes  enroute  to  the  goal  will  create  boundaries  of  different  analytic  characteristics.  However,  tlie  con¬ 
cept  is  promising. 

To  divide  decomposable  terrain  features  (see  Section  C  above  for  a  definition  of  decomposability)  of  the 
input  map  into  two  approximately  equal  sets  whose  resulting  OPM’s  can  be  merged  is  not  difficult.  In  fact,  it 
appears  that  any  partition  is  feasible  as  long  as  it  does  not  split  a  terrain  feature,  but  some  will  be  much  more 
efficient  than  others.  Of  course  the  advantage  of  a  divide-and-conquer  algorithm  is  its  logarithmic  performance 
in  the  recursive  stage  if  it  is  guaranteed  that  divisions  are  approximately  equal-sized,  so  any  partitioning  pro¬ 
cedure  should  have  this  property.  Also,  it  should  not  take  an  excessive  amount  of  time  to  accomplish  the  par¬ 
tition,  since  this  step  will  play  an  important  pan  in  the  overall  time  complexity.  And  thirdly,  since  the  merging 
step  will  depend  on  checking  for  intersections  between  ail  boundaries  of  one  sub-GPM  and  all  boundaries  of 
the  other,  it  would  be  very  useful  if  it  were  not  necessary  actually  to  check  most  of  these  boundaries.  Tliis 
would  be  the  case  if  at  each  step  in  the  recursion,  the  two  OPM’s  represented  terrain  which  did  not,  loosely 
speaking,  "interleave".  For  such  OPM's,  boundaries  which  lav  wholly  within  the  interior  cf  the  two  planar 
partitions  would  not  have  to  be  checked  for  intersection. 

The  merge  step  depends  on  the  fact  that  any  two  boundaries,  when  they  intersect,  represent  the  meeting 
point  of  three  regions,  one  of  which  is  common  to  both  boundaries.  A  new  boundary  will  emanate  from  the 
point  of  intersection  which  separates  the  two  regions  which  (he  original  boundaries  did  not  have  in  common. 
Rather  than  attempt  to  study  all  the  special  cases  of  possible  region  intersections  among  boundaries  present  in 
the  nine  algorithms  thus  far  presented,  it  is  preferable  to  use  the  unifying  approach  to  boundary  generation 
which  considers  the  two  types  of  region  roots  involved  and  selects  from  the  limited  number  of  boundary  types 
to  find  the  new  boundary.  However,  since  there  are  infinitely  many  possible  types  of  Snell ’s-Law  edges  based 
on  the  number  of  edge-crossings  between  the  edge  and  the  goal,  an  approximate  solution  is  proposed.  Since 
boundaries  between  Snell 's-Law  edges  are  similar  to  hyperbolas,  it  is  proposed  that  for  all  except  the  varieties 
already  derived  in  Appendix  A,  hyperbolas  be  used  as  approximations  to  the  exact  curves. 

When  a  new  boundary  has  been  generated  because  of  the  intersection  of  two  boundaries  from  different 
sets,  the  effects  may  propagate  into  both  partial  OPM ’s.  This  will  be,  in  the  worst  case,  a  very  expensive  opera¬ 
tion,  because  unlike  Voronoi  diagram  construction,  the  boundaries  between  regions  are  not  simple  lines,  and 
the  effects  are  not  guaranteed  to  be  local.  Each  boundary  which  is  truncated  by  the  new  boundary  must  be  fol- 
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lowed  to  its  end  (before  it  was  truncated;,  and  if  it  intersected  other  boundaries,  these  in  turn  must  be  recon¬ 
sidered  with  respect  to  the  new  boundary. 

Algorithm  VI-9  describes  this  method  of  constructing  an  optimal-path  map  for  input  maps  containing 
any  number  of  the  seven  types  of  primitive  terrain  features  and  connected  river  and  road  segments.  At  each 
level  of  recursion,  the  algorithm  divides  the  terrain  into  two  roughly  equal  sets,  based  on  a  calculation  of  the 
median  leftmost  vertex.  At  the  lowest  level,  that  of  a  single  terrain  feature,  the  algorithm  calls  on  Algorithms 
VI-I  through  VI-8  to  construct  an  OPM  for  the  feature.  At  higher  levels,  OPM’s  are  merged  by  procedure 


merge-opms. 


VII.  ANALYSIS  OF  DIVIDE-AND-CONQUER  EXACT-OPM  ALGORITHM 


A.  SOURCES  OF  ERROR  IN  THE  ALGORITHM 

The  divide-and-conquer  exact-OPM  algorithm  produces  a  more  accurate  optimal-path  map  than  the 
wavefront-propagation  OPM  algorithm,  but  it  still  has  error  with  respect  to  the  conceptual  OPM  it  models.  In 
terms  of  the  categories  of  error  discussed  in  Chapter  n,  the  model-cost  versus  real-world-cost  error  occurs  be¬ 
cause  of  approximations  in  the  terrain  database  of  continuously-varying  terrain  with  12.5m  square  cells. 

The  second  category  of  error,  model-compu  ted-cost  versus  model-optimal-cost,  appears  in  several  forms 
in  the  output  of  this  algorithm.  Tbs  two  most  significant  are  discussed  here.  First,  each  boundary  whose  analyti¬ 
cal  form  does  not  have  a  closed-form  solution  is  represented  by  a  piece  wise-linear  approximation.  These  boun¬ 
daries  are  plotted  parametrically,  iteratively  setting  one  parameter  and  solving  for  the  other.  Fortunately  for 
the  precision  of  the  algorithm,  most  boundaries  have  very  little  curvature  (see  for  example,  Figures  22, 23,  and 
24).  An  exact  analysis  of  the  impact  of  this  type  of  error  has  not  been  done,  but  the  proof-of-concept  implemen¬ 
tation  for  the  high-cost,  exterior-goal  homogeneous-cost  area  (HCA)  plotted  twenty  or  fewer  points  for  each 
curve,  and  in  all  test  cases,  error  of  this  type  was  too  small  to  be  visible  in  the  laser-printer  output 

What  error  does  occur  will  have  the  effect  of  causing  start  points  which  are  close  to  a  boundary  to  be 
placed  in  an  incorrect  region.  These  start  pcruls  will  then  be  associated  with  paths  which  are  not  quite  optimal. 
But  along  a  boundary  there  are  two  equal-cost  paths  to  the  goal  from  each  start  point.  On  an  approximate 
boundary  one  of  these  two  paths  will  be  slightly  more  costly  than  the  other.  This  error  will  be  no  greater  than 
the  cost-rate  in  the  region  times  the  maximum  distance  of  the  piece  wise-linear  approximation  from  the  actual 
curve.  Since  the  approximations  seem  to  be  very  close  to  the  actual  curve  in  observed  cases,  it  seems  safe  to 
state  that  this  error  can  be  ignored  in  most  practical  applications. 

A  second  source  of  error  in  the  category  of  model-computed-cost  versus  model-optimal-cost  is  using  hy¬ 
perbolas  to  approximate  boundaries  between  homogeneous-behavior  regions  having  paths  with  more  than  two 
Snell’s-Law  crossings.  An  exact  analysis  of  the  error  caused  here  has  not  been  dooe.  But  for  regions  whose 
paths  have  multiple  Snell’s-Law  crossings  leading  to  a  region  root  which  is  a  point,  as  the  regions  lie  further 
and  further  away  from  the  point,  they  have  cost  functions  (called  "distorted  cones")  which  have  flatter  and 
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flatter  iso-cost  contours,  leading  to  boundaries  with  less  and  less  curvature.  The  approximating  hyperbola 
should  be  closer  and  closer  to  the  actual  boundary  as  the  boundary  becomes  almost  linear.  The  error  in  the 
computed  cost  of  an  optimal  path  caused  by  this  approximation  can  be  ignored  in  most  applications. 

The  third  category  of  error  discussed  in  Chapter  A,  that  of  modcl-computed-location  versus  model-op¬ 
timal-location,  occurs  only  in  the  situations  discussed  above  where  a  start  point  is  incorrecdy  placed  on  the 
wrong  side  of  a  boundary.  When  this  happens,  the  computed  path  will  have  a  distinctly  different  behavior  than 
the  true  optimal  path. 

B.  TIME  AND  SPACE  COMPLEXITY  OF  THE  ALGORITHM 

We  begin  by  analyzing  the  construction  of  the  optimal-path  tree,  and  then  analyze  the  algoritlims  proposed 
for  each  primitive  terrain  feature  type  in  an  isolated  setting,  because  the  final  algorithm  uses  the  previous  ones 
as  base  cases  of  its  recursion. 

1.  Time  and  Space  Complexity  of  Optimal-Path  Tree  Construction 

Prior  to  the  execution  of  the  algorithms  introduced  in  Chapter  VI,  the  optimal-path  tree  (OPT)  must 
be  constructed.  A  brute-force  method  which  finds  optimal  paths  from  each  terrain-feature  vertex  and  then  in¬ 
serts  each  path  into  the  OPT  would  take,  using  the  continuous-Dijkstra  algorithm,  0(n*L)  time  in  the  worst 
case,  and  using  recursive  wedge  decomposition,  0(n3)  in  the  average  case,  where  n  is  the  number  of  terrain- 
feature  vertices,  and  L  is  a  measure  of  the  precision  of  the  problem  representation.  Insertion  into  the  OPT  as 
described  in  Chapter  VI  would  take,  in  the  worst  case,  no  more  than  Ofn2)  time,  because  no  path  list  is  longer 
than  n,  and  there  are  n  path  lists  to  be  inserted.  The  optimal-path  tree  has  no  more  than  one  node  for  each  ter¬ 
rain-feature  vertex  and  edge,  plus  one  for  the  goal  poin*.  Thus,  its  worst-case  space  complexity  is  O(n),  since 
with  the  assumed  terrain  constraints,  there  are  0(n)  edges.  A  more  efficient  way  to  use  the  continuous-Dijkstra 
algorithm  is  possible  which  computes  paths  to  all  vertices  and  builds  the  OPT  in  one  execution  of  the  algo- 
rithm,  giving  0(n  L)  worst-case  time  complexity.  Recursive  wedge  decomposition  can  also  be  modified  to 

nnerate  Ihi*  wav. 

‘k - - -  * 

2.  Time  and  Space  Complexity  of  The  Single-Obstade-OPM  Algorithm  t 

Algorithm  VI- 1  constructs  an  optimal-path  map  for  a  single  isolated  convex  obstacle  with  respect  to 

a  goal  For  an  obstacle  with  n  vertices  there  are  at  most  n  shadow  boundaries,  which  can  be  constructed  in 
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0(n)  time  by  a  depth-first  traversal  of  the  the  optimal-path  tree,  generating  a  shadow  boundary  for  each  node 
in  the  tree  except  the  one  representing  the  empty  path  list.  Each  hyperbola  segment  which  is  part  of  the  op¬ 
posite  edge  can  be  constructed  in  constant  time,  and  there  are  at  most  n-2  intersections  of  the  opposite-edge 
boundary  with  shadow  boundaries.  Thus  the  opposite-edge  boundary  can  be  constructed  in  O(n)  time,  so  the 
entire  OPM  can  be  constructed  in  0(n)  time.  Each  shadow  boundary  and  each  hyperbola  segment  of  the  op¬ 
posite-edge  boundary  can  be  represented  in  O(constant)  space.  Since  the  optimal-path  tree  can  be  stored  in 
0(n)  space,  and  assuming  constant  accuracy,  the  representation  of  the  entire  OPM  is  0(n)  space.  (See  Figure 
17.) 

3.  Time  and  Space  Complexity  of  The  Single- River-Segment-OPM  Algorithm 

Algorithm  VI-2  constructs  boundaries  generated  by  a  single  river  segment.  A  river  segment  has  ex¬ 
actly  two  shadow  boundaries,  at  most  two  river-crossing  boundaries,  and  exactly  one  river-obstacle  boundary 
consisting  of  only  one  hyperbola  segment.  Thus  there  at  most  five  boundaries  to  construct,  each  of  which  can 
be  constructed  in  0(constant)  time,  so  the  time  complexity  of  the  algorithm  is  O(constant).  Similarly,  the  space 
complexity  is  O(constant).  (See  Figure  18.) 

4.  Time  and  Space  Complexity  of  The  Singk-Road-Segment-OPM  Algorithm 

Algorithm  VI-3  constructs  boundaries  generated  by  a  single  road  segment.  By  the  analysis  of  Chap¬ 
ter  V,  a  road  segment  may  have  at  most  fourteen  boundaries,  each  of  which  can  be  constructed  in  O(constant) 
time,  using  O(constant)  space.  Thus  the  time  and  space  complexity  of  Algorithm  VI-3  are  both  O(constant). 
(See  Figure  20  and  21.) 

5.  Time  and  Space  Complexity  of  The  High-Cost-Exterior-Goal-HCA-OFM  Algorithm 

Algorithm  VI-4  constructs  the  planarpartilion  for  a  region  with  higher  cost  than  the  surrounding  ter¬ 
rain  with  a  goal  point  outside  the  region.  It  has  exterior  boundaries  which  are  similar  in  number  to  those 
generated  by  an  obstacle,  except  that  there  may  be  as  many  as  three  opposite-edge  boundaries.  Thus,  by  the 
same  reasoning  as  for  obstacles,  the  construction  of  exterior  boundaries  has  worst-case  time  and  space  com¬ 
plexity  of  0(n). 

However,  the  interior  boundaries  are  more  time-consuming  in  the  worst  case,  because  of  the  way 
boundaries  may  intersect  (See  figures  22, 23, 24, 30, 31,  and  32.)  Each  of  the  n  HCA  vertices  is  associated 
with  an  interior  boundary.  In  the  worst  case,  each  pair  of  these  boundaries  intersects  and  a  third  boundary 
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begins  at  the  intersection  point,  giving  n/2  new  boundaries,  and  each  pair  of  new  boundaries  intersects  and 
another  begins,  for  n/4  new  boundaries  at  the  third  level,  and  so  on  until  a  final  boundary  occurs  which  con¬ 
nects  all  the  others.  In  tills  case,  there  are  n+n/2+n/4+n/8+...+l  boundaries.  There  are  in  the  limit  n/(l-l/2)  = 
2n  boundaries. 

There  does  not  appear  to  be  a  simple  way  to  determine  for  a  boundary  which  of  the  two  adjacent 
boundaries  will  be  paired  with  it  An  iterative  check  which  accomplishes  this  is  outlined  in  procedure  pair- 
and-merge-bdrys  under  Algorithm  VI-4,  (see  Section  A4  of  Chapter  VI  and  Figure  30).  This  procedure  takes 
at  worst  (in  a  very  pathological  case),  n-2  passes  through  the  inner  ("while  PairedBdrySet  is  changing")  loop, 
which  itself  processes  n  boundaries  ("for  all  Bi,j...").  The  outer  ("while  BdrySet  is  changing")  loop,  which 
checks  for  intersections  by  newly  propagated  boundaries  with  already-paired  boundaries,  could  also  take  O(n) 
passes  in  the  worst  case.  Thus  procedure  pair-and-merge-bdrys  has  worst-case  time  complexity  of  0(n3). 
This  measure  dominates  the  0(n)  complexity  of  the  exterior  boundaries,  and  so  the  worst-case  time  complexity 
of  Algorithm  VI-4  is  0(n3).  The  space  complexity  is  O(n)  because  at  most  2n  interior  boundaries,  n-2  shadow 
boundaries,  and  n-2  portions  of  opposite-edge  boundaries  exist. 

6.  Time  and  Space  Complexity  cf  The  High-Cost-Interior-Goal-HCA-OPM  Algorithm 
Algorithm  VI-5  constructs  the  OFM  for  a  high-cost  HCA  with  an  interior  goal  point.  It  has  much 

lower  time  complexity  than  the  high-cost,  exterior-goal  case,  because  the  interior  does  not  have  a  number  of 
intersecting  boundaries  from  which  more  boundaries  may  emanate.  In  fact,  for  each  vertex,  at  most  one  ex¬ 
terior  and  four  interior  boundaries  are  generated,  as  well  as  additional  boundaries  for  each  pair  of  visible  edges 
aod  each  interior  opposite-edge  boundary.  Both  the  exterior  visible-edge  boundaries  and  the  exterior  opposite- 
edge  boundaries  display  the  same  behavior  as  obstacle  opposite-edge  boundaries,  so  that  all  of  them  together 
have  no  more  than  O(n)  segments.  The  only  iterative  loop  in  the  algorithm  is  the  outer  one  which  processes 
each  of  the  n  vertices,  so  the  overall  worst-case  time  complexity  is  0(n),  as  is  the  space  complexity.  (See  Figure 
25.) 

7,  Tim?  *sd  Sp*€t  Complexity  of  The  Lom-Cost-F-xterior-Qoxl-HCA-QPM  Algorithm 
Algorithm  VI-6  constructs  the  OFM  for  a  HCA  of  lower  cost  than  the  surrounding  terrain  and  an  ex¬ 
terior  goal.  This  algorithm  generates  at  most  four  boundaries  per  HCA  vertex.  Although  there  are  interior  boun¬ 
daries  similar  to  the  high-cost,  exterior-goal  case  where  much  computing  effort  was  required  to  construct  them. 
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in  this  case  they  are  never  mutually  intersecting.  Thus  the  entire  algorithm  has  time  complexity  0(n).  The 
space  complexity  is  also  0(n).  (See  Figure  27.) 

8.  Time  and  Space  Complexity  of  The  Low-Cost-Interior-Goal-HCA-OPM  Algorithm 
Algorithm  VI-7  constructs  the  OPM  for  a  HCA  with  lower  cost  than  the  surrounding  terrain,  and  a 

goal  inside  the  HCA.  This  is  the  simplest  of  the  four  HCA  cases,  because  there  are  exactly  two  linear  boun¬ 
daries  emanating  from  each  HCA  vertex.  Thus  the  time  and  space  complexity  is  0(n).  (See  Figure  26.) 

9.  Time  and  Space  Complexity  of  The  Multipk-Connected-River-Segment-OPM  Algorithm 
Algorithm  VI-3  constructs  an  OPM  for  multiple  connected  river  segments.  The  time  complexity  of 

this  algorithm  depends  on  how  many  "event  points"  and  new  boundaries  occur  at  each  segment  An  event  point 
occurs  on  a  river  segment  2t  each  place  that  a  boundary  intersects  it  and  denotes  a  point  at  which  the  algorithm 
must  check  for  a  continuation  of  the  boundary  on  tbe  other  side  of  the  segment.  Since  a  river  segment’s  boun¬ 
daries  will  only  intersect  river  segments  in  its  shadow,  the  worst-case  time  complexity  happens  when  the  river 
"doubles  back"  on  itself.  Consider  a  sequence  of  connected  river  segments  as  in  Figure  34.  In  this  example, 
tbe  closest  two  river  segments  to  tbe  goal,  and  each  subsequent  pair  of  segments,  are  positioned  so  as  to  cast 
two  shadow  boundaries  which  create  event  points  on  the  next  segment  Since  in  this  example,  the  cost  of  the 
river  is  so  small  that  each  river-crossing  boundary  begins  "outside"  any  event  points  on  tbe  segment  and  does 
not  intersect  any  shadow  boundaries,  the  shadow  boundaries  all  continue  to  the  next  level  of  river  segments. 
At  tbe  first  level,  four  boundaries  begin,  and  at  each  subsequent  level,  there  are  three  Dew  boundaries  plus  the 
continuation  of  boundaries  from  previous  levels  associated  with  event  points.  The  result  is  that  on  each  river 
segment,  say  at  level  i,  there  are  3i+l  possible  boundaries  generated.  So  for  a  sequence  of  river  segments  with 
n  vertices,  it  is  possible  to  have  Xt>l  to  n/2  (3i  + 1)  *  3n2/8  -  7n/4  total  boundaries  over  the  entire  set.  Thus  the 
worst-case  time  complexity  of  Algorithm  VI-8  is  CKn2).  Since  there  are  0(n2)  boundary  segments,  the  worst- 
case  space  complexity  is  also  0(n2). 

10.  Time  and  Space  Complexity  of  The  Multipk-Feature-Divide-and-Conquer-OPM  Algorithm 
Algorithm  VI-9  is  tbe  algorithm  which  takes  OPM’s  for  individual  decomposable  terrain  features  and 

merges  them  into  one  OPM.  It  uses  tbe  divide-and-cooquer  paradigm,  and  spends  0(n)  time  dividing  tbe  map 
at  each  stage  of  size  n,  by  standard  median-finding  algorithms  from  computational  geometry.  Let  tbe  time 
complexity  of  the  algorithm  itself  be  expressed  as  T(n).  Then  the  recursive  application  of  tbe  algorithm  to  both 
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halves  of  the  map  will  take  2T(n/2)  time.  Thus  the  dividing,  recursion,  and  merging  will  take  T(n)  =  O(n)  + 
2T(n/2)  +  0(f(n)),  where  Ifn)  is  the  time  complexity  of  the  merge  step. 

The  procedure  merge-opms  is  very  similar  to  procedure  pair-and-merge-bdrys  associated  with  Al¬ 
gorithm  V-4  for  high-cost,  exterior-goal  HCA  OPM’s,  which  joined  the  interior  boundaries  and  propagated 
new  ones  as  needed.  It  is  subject  to  the  same  possibility  that  multiple  levels  of  newly-propagated  boundaries 
may  occur,  and  has  the  added  complexity  that  for  each  boundary  truncated  in  one  of  the  subordinate  OPM’s, 
the  procedure  intersect-and-merge  must  be  performed  to  reconstruct  any  other  boundaries  which  previously 
intersected  the  truncated  boundary  but  no  longer  do  so.  By  the  same  reasoning  as  paragraph  4  above,  even  as¬ 
suming  that  procedure  intersect-and-merge  has  O(constant)  worst-case  time  complexity,  procedure  merge- 
opms  operates  in  0(n3)  time.  In  fact,  procedure  intersect-and-merge  operates  in  0(n)  time  in  the  worst  case, 
because  there  are  at  most  0(n)  boundaries  which  a  boundary  can  possibly  intersect.  Thus,  procedure  merge- 
opms  has  worst-case  time  complexity  0(n4).  We  note  also  that  the  base  case  of  the  recursion  requires  the  solu¬ 
tion  of  a  single-terrain-feature  algorithm,  which  may  have  as  much  as  0(n3)  time  complexity.  Thus  the 
worst-case  time  complexity  of  the  entire  algorithm  may  be  stated  as  T(n)  <,  0(n)  +  2T(n/2)  +  0(n4),  or 

T(n)  <,  2T(n/2)  +  0(n4) 

forT(I)  <1 0(m3),  where  m  is  the  largest  number  of  terrain-feature  vertices  which  occur  in  a  high-cost,  ex¬ 
terior-goal  HCA.  Expanding  this  recurrence  relation,  gives,  by  induction  on  the  depth  i  of  the  recursion,  that 
for  some  constant  cj, 

T(n)  £  i'Tiafz)  +  cm4(l  -  l/23(i‘,)). 

t* 

Let  n  «  2  ,  assuming  that  k  is  an  integer.  Then  at  the  last  splitting  step,  i=k,  and  we  have  that 

T(n)  £  2kT(l)  +  cjn4(l  -  l/23(k'1)). 

But  for  the  base  case,  we  have  that  T(l)  ^  can  for  some  constant  C2,  so 

T(n)  £  2kC2m3  +  cin4(I  -  l/23(k*l>) 

T(n)  2  C2nm3  +  cm4  -  8  cjn. 

Since  m  ^  n,  Algorithm  VI-9  h3s  worst-case  time  complexity  T(n)  =  0(n4). 
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C.  EMPIRICAL  PERFORMANCE  OF  THE  ALGORITHM  IMPLEMENTATION 

The  high-cost,  exterior-goal  case,  was  implemented  as  a  proof-of-concept  program.  The  high-cost,  ex¬ 
terior-goal  HCA  was  chosen  because  it  was  the  most  complex  of  the  seven  cases  and  incorporated  most  of  the 
types  of  boundaries.  The  implementation  was  not  intended  to  be  particularly  efficient,  but  was  primarily 
designed  to  corroborate  the  shapes  of  various  boundaries  when  compared  with  multiple  runs  of  a  point-to- 
point  weighted-region  path-planning  implementation  by  Richbourg  [Ref.  21].  Figures  22, 23,  and  24  repre¬ 
sent  results  of  the  OPM  implementation  overlaid  on  vectors  representing  the  initial  directions  of  a  dense 
sampling  of  optimal  paths  from  Richbourg’s  "Snell’s  Law"  program.  OPMs  of  fairly  simple  complexity  such 
as  the  above  three  figures  took  four  to  six  minutes  apiece  to  construct,  not  counting  the  time  necessary  to  find 
optimal  paths  from  each  terrain-feature  vertex  using  Richbourg’s  point-to-point  path-planner  [Ref.  21].  This 
implementation  was  done  in  C-Prolog  on  a  VAX  1 1/785  running  under  BSD  4.3  Unix. 
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Vffl.  CONCLUSIONS 


A.  GENERAL 

In  this  research  we  developed  two  approaches  to  the  construction  of  a  planar  partition  for  optimal-path 
maps  (OPM).  The  first  is  an  extension  of  the  grid-based  wavefront  propagation  algorithm  for  point-to-point 
path  planning,  for  which  we  implemented  and  analyzed  three  versions.  The  second  is  based  on  spatial  reason¬ 
ing  about  how  optimal  paths  behave  in  the  presence  of  terrain  features,  leading  to  a  divide-and-conquer  algo¬ 
rithm.  We  assume  that  paths  lie  in  free  terrain  consisting  of  five  types  of  regions:  homogeneous-cost 
background,  convex  polygonal  obstacles,  piecewise-linear  riven  with  a  fixed  crossing  cost,  piecewise-linear 
roads  with  a  constant  cost-rate,  and  convex  homogeneous-cost  areas.  Additionally,  we  assume  that  no  two  fea¬ 
tures  share  a  vertex.  We  assume  that  the  mobile  agent  is  of  negligible  3ize  with  respect  to  the  surrounding  ter¬ 
rain,  anil  that  the  terrain  is  fixed  and  known. 

Point-to-point  path-planning  algorithms  require  anywhere  from  0(n2  log  n)  time  for  binary  terrain 
(visibility-graph  methods  (Ref.  1])  to  0(n7L)  time  for  homogeneous-cost  areas  (continuous-Dijkstra  algorithm 
(Ref.  IS]),  where  n  is  the  number  of  terrain-feature  vertices  and  L  is  a  measure  of  the  precision  of  the  problem 
representation.  One  way  to  decrease  the  amount  of  run-time  complexity  of  path-planning  at  the  expense  of  in¬ 
creased  preprocessing  time  and  increased  storage  requirements  is  to  construct  optimal-path  maps  (OPM)  which 
group  optimal  paths  from  all  start  points  on  a  map  with  respect  to  a  goal  point  by  partitioning  the  plane  into 
regions  whose  pads  behave  similarly.  At  run-time  standard  point-location  techniques  from  computational 
geometry  can  be  used  to  locale  a  start  point  in  a  region  of  the  OPM  in  0(log  n)  time,  and  the  optimal  path  can 
be  reconstructed  based  on  the  known  behavior  of  paths  in  the  region. 

1.  COMPARISON  OF  WAVEFRONT-PROPAGATION  TO  SPATIAL-  REASONING 
APPROACHES  TO  OPM  CONSTRUCTION 

The  spatial  reasoning  approach  to  optimal-patb-map  construction  is  clearly  preferable  to  wavefront 

\ 

propagation  for  applications  requiring  low  error  in  the  cost  of  the  solution  path  compared  with  the  cost  of  the 
actual  optimal  path.  Otherwise,  the  wavefront-propagation  approach  using  the  diverging-path  version  seems 
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preferable  because  it  does  not  depend  on  the  labeling  of  vertex  or  edge  cells,  and  is  simpler  than  the  exact  al¬ 
gorithm,  when  the  cost  of  constructing  the  optimal-path  tree  is  included.  The  most  accurate  wavefront-propaga¬ 
tion  OPM  algorithm,  the  vertex-edge  version,  requires  an  additional  preprocessing  phase  which  fits  polygons 
to  grid-based  terrain  features  and  assigns  vertex  and  edge  labels  to  cells.  This  terrain  preprocessing  is  also 
necessary  in  the  spatial-reasoning  approach  used  on  large-scale  cross-country  terrain  data,  because  Defense 
Mapping  Agency  provides  data  in  the  form  of  25  meter  or  12.5  meter  square  grid  cells  from  which  the  polygonal 
terrain  features  of  the  spatial-reasoning  approach  must  be  derived.  Since  implementation  of wavefront  propaga¬ 
tion  is  simpler  than  the  exsct-OPM  divide-and-conquer  algorithm,  it  may  be  preferable  in  applications  which 
can  afford  the  7.6%  inaccuracy  to  use  the  vertex-edge  version  of  wavefront  propagation. 

While  wavefront  propagation  would  seem  to  be  preferable  if  accuracy  is  not  a  factor,  it  should  be  noted 
that  the  complexity  of  wavefront  propagation  is  based  on  the  number  of  cells  in  the  input  map,  not  the  num¬ 
ber  of  terrain-feature  vertices,  so  the  two  time  complexity  measures  are  not  precisely  comparable.  However, 
for  a  grid-based  map  of  0(m)  cells,  with  a  corresponding  polygonal  map  of  v  vertices,  if  it  could  be  said  that 
the  frequency  with  which  a  cell  includes  a  vertex  would  be  constant  as  the  size  of  the  map  increased,  v  would 
increase  linearly  as  a  function  of  m.  By  this  reasoning,  we  could  expect  a  typical  polygonal  map  for  a  grid  with 
m  cells  to  have  0(m)  vertices,  so  the  measures  are  approximately  comparable. 

Actual  avenge  performance  could  give  different  results  from  worst-case  analysis.  Since  the  spatial- 
reasoning-OPM  divide-and-conquer  algorithm  was  implemented  only  for  one  of  the  seven  cases  as  a  test-of- 
coocept  instrument,  actual  performance  tests  of  the  exact- OPM  algorithm  were  not  possible. 

C.  USEFULNESS  OF  THE  OPM  APPROACH  TO  PATH  PLANNING 

Since  the  OPM  approach  to  path  planning  trades  preprocessing  time  and  increased  storage  for  improver" 
speed  at  run-time,  it  will  be  useful  in  applications  which  require  real-time  response  to  a  path-planning  query, 
such  as  autonomous-vehicle  or  missile  pathplanning,  or  where  multiple  queries  over  the  same  terrain  are  ex¬ 
pected,  for  example,  in  a  terrain-analysis  decision  aid  for  tactical  military  units. 

Two  major  objections  to  the  OPM  approach  are  its  preprocessing  time  and  its  storage  requirements.  Cer¬ 
tainly  preprocessing  will  take  longer  than  current  path-planting  methods.  However,  (be  non- automated  ap¬ 
proach  to  terrain  navigation  in  many  domains,  which  has  been  to  prepare  paper  maps  well  ahead  of  time  for 
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distribution  to  useis,  could  serve  as  a  model  for  OPM  preprocessing,  wherein  an  organization  such  as  Defense 
Mapping  Agency  could  devote  centralized  resources  to  the  preprocessing  phase  and  distribute  standard  OPM 
databases  so  that  field  units  or  vehicles  would  have  to  devote  resources  only  to  the  run-time  phase. 

A  second  objection  to  the  OPM  approach  is  the  need  for  increased  storage.  However,  the  cost  and  com¬ 
pactness  of  storage  media  is  constantly  being  reduced  by  research  and  development  efforts.  OPM  databases 
could  be  recorded  on  optical  disks  or  "digital  paper",  allowing  space  for  a  whole  array  of  OPMs  covering  an 
approximation  of  the  four-dimensional  solution  for  a  given  geographical  area.  A  typical  OPM  for  an  area  of 
20  by  20  kilometers  might  include  on  the  order  of  800,000  boundary  segments  (100  vertices  per  square 
kilometer  times 400 square  kilometers  giving  on  the  order  of 40,000  boundaries,  times  20  segments  per  bound¬ 
ary),  each  requiring  two  points  of  two  coordinates  each,  or  3.2  megabytes  of  storage.  For  a  four-dimensional 
array  of  OPM’s  representing  all  optimal  paths  from  any  start  point  to  a  sampling  of  perhaps  10  goal  points  per 
square  kilometer,  or  4,000  OPMs,  12.8  gigabytes  would  be  required.  As  of  1989, 5-1/4-inch  disks  using  digi¬ 
tal-paper  technology  are  commercially  available  which  store  1  gigabyte  each  [Ref.  45].  The  approximately 
thirteen  such  disks  needed  to  store  a  full  set  of  OPMs  would  be  easily  transportable.  A  library  of  OPMs  for 
various  potential  areas  of  operation  could  be  maintained,  for  example,  much  as  libraries  of  paper  maps  are 
maintained. 

D.  AREAS  FOR  ADDITIONAL  RESEARCH 

The  terrain  types  assumed  herein  do  not  include  noo-convex  polygons,  even  though  much  real-world  ter¬ 
rain  would  be  difficult  to  model  accurately  without  them.  Thus,  it  is  important  to  determine  how  to  incorporate 
noo-convex  polygons  into  the  optimal-path  map  algorithms  presented.  With  the  unifying  view  of  regions  and 
boundaries  based  on  region  cost  functions,  this  task  seems  attainable  with  additional  research. 

The  boundary  between  regions  where  one  or  both  regions  have  paths  which  cross  multiple  Snell’s-Law 
edges  en  route  to  a  region  root  which  is  a  point  has  not  been  characterized  analytically.  In  the  current  algo¬ 
rithm,  it  is  proposed  that  such  boundaries  be  approximated  by  hyperbolas,  and  it  is  thought  (without  proof) 
that  such  an  approximation  introduces  very  little  error.  However,  a  better  approximation  could  be  used  tp  in¬ 
tersect  with  other  cost  functions  to  determine  boundaries  on  a  much  less  ad  hoc  basis  than  is  done  in  this  dis¬ 
sertation. 
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One  specific  place  in  which  improvement  in  efficiency  could  have  great  effect  on  the  overall  exact-OPM 
algorithm  is  in  constructing  the  interior  boundaries  of  an  exterior-goal,  high-cost  HCA  in  less  than  0(ri*)  time. 
OPM’s  for  all  six  other  primitive  terrain-features  can  be  constructed  in  C(n)  or  less  time,  and  for  multiple  con- 
nected  river  segments  in  0(n  )  time,  and  it  is  this  single  case  which  drives  the  divide-and-conquer  algorithm’s 
worst-case  time  complexity  to  0(n*).  In  addition,  a  merge  procedure  for  the  exact-OPM  divide-and-conquer 
algorithm  which  had  efficiency  mote  in  line  with  that  of  Voronoi  diagram  construction  would  improve  over¬ 
all  performance. 

A  four-dimensional  solution  is  needed  in  order  to  make  the  OPM  approach  useful  in  most  domains.  The 
solution  consistent  with  the  approach  herein  is  to  create  multiple  OPM’s  for  a  sampling  of  goal  points  in  the 
plane,  and  then  choose  the  OPM  to  use  at  run-time  based  on  the  proximity  of  the  query  goal  point  to  the  goal 
point  of  one  of  the  OPM’s.  Perhaps  more  efficient  methods  exist  which  would  characterize  boundaries  be¬ 
tween  four-dimensional  regions  in  a  space  of  all  start  and  goal  points,  a  conceptual  generalization  of  the  two- 
dimensional  solutions  reported  here  for  start  points  and  a  fixed  goal.  In  other  words,  the  four-dimensional 
hyperplane  would  be  partitioned  into  regions  whose  paths  were  similar. 

It  would  be  very  instructive,  as  well  as  practical,  to  implement  a  complete  two-dimensional  path-plan¬ 
ning  system,  from  construction  of  an  optimal-path  tree  for  the  four  types  of  terrain  used  herein  through  OPM 
construction,  and  including  a  run-time  system  to  accomplish  point  location  and  path  reconstruction. 


APPENDIX  A  -  THEOREMS 


A.  OVERVIEW 

In  this  appendix  the  theorems  which  form  the  basis  of  the  research  reported  herein  are  presented,  along 
with  associated  lemmas,  corollaries,  and  fundamental  assumptions.  The  theorems  follow  in  the  same  order  in 
which  they  are  discussed  in  the  body  of  this  report,  and  are  numbered  by  chapter  and  theorem.  Lemmas  and 
corollaries  ate  numbered  as  extensions  of  the  theorem  to  which  they  apply.  First,  some  notation  used  in  this 
appendix  and  throughout  the  report  is  presented.  Then  three  theorems  and  a  fundamental  assumption  with  three 
associated  corollaries  are  presented  which  provide  a  theoretical  foundation  for  the  discussions  of  Chapter  I. 
Next  six  theorems  are  presented  which  state  the  basic  boundary  equations  as  developed  by  the  unifying  view 
of  region  cost  functions.  Seven  theorems  from  Chapter  V,  one  for  each  of  the  three  terrain-feature  types 
obstacle,  road  segment,  and  river  segment,  and  four  for  the  four  cases  of  the  homogeneous-cost  area,  are 
presented.  The  definition  of  homogeneous-behavior  region  used  in  this  appendix  is  the  set  of  all  points  whose 
optimal  paths  have  the  same  path  list 


B.  NOTATION 


The  following  notation  is  introduced  for  use  with  respect  to  path-planning. 


Example 

Description 

P 

A  point  in  Euclidean  n-space. 

KJ 

The  straight-line  segment  from  P  to  Q 

(PQ) 

A  feasible  path  from  P  to  Q 

(PQX 

The  i*  feasible  path  from  P  to  Q 

(PQ)* 

Optimal  path  from  P  to  Q 

OPL(P) 

Optimal-path  list  (sequence  of  edges  and  vertices  encountered)  of  P. 

OPL(P)  =  [P,QiOPL(Q)] 

The  path  list  from  P  through  Q  shown  in  Prolog-style  list  notation 
(i.e.,  lists  are  enclosed  in  braces,  commas  separate  elements,  and  the 

entry  following  a  vertical  line  (T)  is  the  "rest"  of  the  list). 

l(PQ)il 

The  cost  (weighted  distance)  from  P  to  Q  via  path  (PQ)i. 

d(P,Q) 

The  Euclidean  distance  between  P  and  Q. 

((PQ)i(QR)j) 

A  feasible  path  from  P  through  Q  to  R. 
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(PQ)iC  ((PQ)i(QR)j)  Set  notation  applies  to  paths  as  if  to  their  path  lists,  treating  them  as 

(QP)i  <2  ((PQ)i(QR)j)  ordered  sets,  e.g.,  (PQ)i  is  a  sub-path  of  ((PQ)i(QR)j),  but 

(QP)i  is  not  a  sub-path  of((PQ)i(QR)j). 

Pe  (PQ)i  Points  sue  considered  elements  of  paths. 

(PQ)i  =  (RS)j  iff  (PQ)iC  (RS)j  and  (RS)jC  (PQ)i  Two  paths  are  equal  if  Vk,  the  k* 
elements  of  the  path  lists  of  the  two  paths  are  the  same. 

Cpq  The  cost  (weighted  distance)  of  a  path  from  point  P  to  point  Q 

n  The  cost  rate  in  region  i. 

01  Angle  of  incidence  or  refraction  of  a  path  across  a  SnelTs-Law  edge. 

Y  *  sin’Vi/rc)  Critical  angle  with  respect  to  a  Snell’s-Law  edge  separating 

regions  of  cost-rates  r  1  and  n,  where  ri  <  n. 

VAGB  The  characteristic  wedge  with  vertex  at  G  and  edges  through  A  and  B. 

This  is  defined  with  respect  to  road  segments  such  that  G  is  the  goal 
point,  A  and  B  are  points  on  the  line  of  the  road  segment,  ray  GA  forms 
angle  Jt/2  +  Y  with  the  segment,  and  ray  GB  forms  an  angle  71/2  —  Y 
with  the  segment,  where  Y  is  the  critical  angle  as  defined  above. 

C.  BASIC  THEOREMS 

THEOREM  I-l.Given  optimal  path  (AB)*,  VP  €  (AB)*,  (PB)i  *  (PB)*  if  (PB)i  C  (AB)*,  i.e.,  any  sub¬ 
path  of  an  optimal  path  is  also  an  optimal  path.  (Ihe  generalization  of  this  concept  is  known  in  some  contexts 
as  the  principle  of  optimality,  the  dynamic  programming  principle,  or  the  Markovian  property  [Ref.  46].) 

PROOF  I-l:(Proof  by  Contradiction)  Given  points  A  and  Band  path  (AB)i  *  (AB)*  such  that  KAB)*I  *  c*, 
points  P  and  Q  such  that  Pe  (AB)*andQe  (AB)*,  where  paths  (AP),  (PQ)  and  (QB)  are  such  that 
((APKPQXQB))  »  (AB)*  with  l(PQXQB)l  *  ci,  and  Q'  <E  (AB)*.  (See  Figure  35.) 

Assume  3  (PQ')  and  (Q'B)  such  that  K(PQ'XQ'B))I «  ci',  and  ci'<  ci.  Then  3  (AB)2  - ((APXPQ'XQ'B 
*  '*)>iuch  that  KABW  *  c*  -  ci + ci'.-  But  c*  -  ci  +  ci'  <  c* ,  so  KAB)2l  <  KAB)*I,  which  contradicts  the  op¬ 
timality  of  (AB)*.  ♦ 

THEOREM  1-2.  In  terrain  consisting  of  a  homogeneous-cost  background  on  which  is  placed  homogeneous- 
cost  polygons,  optimal  paths  change  directions  only  at  terrain  feature  vertices  and  edges.  Note  that  the  terrain 
defined  in  Chapter  II,  Section  E,  are  specializations  of  this  type  of  terrain.  (See  Figure  36.) 
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Figure  35 

Principle  of  Optimality  for  Path  Planning 
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Figure  36 

Optimal-Path  Turn  Points 
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PROOF  1-2:  Consider  point  X  on  optimal  path  (AB)*,  with  Pe  (AB)*  and  Q  e  (AB)*  arbitrarily  close  to  X 
such  that  ((PXXXQ))  C  (AB)*,  i.e„  P  and  Q  are  on  opposite  sides  of  X  on  path  (AB)*.  Assume  P,  X,  and  Q 
are  not  colinear  (i.e.,  X  is  a  turn-point).  Among  terrain  consisting  of  line  segments  and  polygons,  P  and  Q  can 
be  made  close  enough  to  X  so  that  there  arc  only  four  possible  placements  of  P,  X,  and  Q: 

(1)  P,  X,  and  Q  are  in  areas  of  equal  cost,  X  is  not  coincident  with  a  terrain  feature  vertex,  and  line 
segment  PQ  does  not  intersect  any  terrain  feature  edge. 

(2)  P,  X,  and  Q  are  in  areas  of  equal  cost,  and  X  is  coincident  with  a  terrain  feature  vertex. 

(3)  X  is  in  an  area  of  equal  cost  with  either  P  or  Q,  but  not  both.  Assume  without  loss  of  generality 
that  P  and  X  are  in  an  area  of  cost  n  and  Q  is  in  an  adjacent  area  of  cost  r2.  Additionally,  X  is  not 
on  a  terrain  feature  edge,  (PX)  does  not  cross  any  edges,  and  (XQ)  crosses  exactly  one  edge,  the 
edge  between  the  two  areas  of  concern. 

(4)  X  is  on  the  terrain  feature  edge  separating  an  area  of  cost  r*  of  w'  ich  P  is  a  member  and  adjacent 
area  of  cost  n  of  which  Q  is  a  member.  Additionally,  neither  (PX)  nor  (XQ)  cross  any  other  edges. 

Assume  case  I.  ((PXXXQ))  =  (PQ)*  by  the  principle  of  optimality.  Sc  :{PX;i  +•  l(XQ)l  £  1PQ!,  because 
of  the  optimality  of  ((PX)(XQ))  (i.e.,  the  cost  from  P  to  Q  via  X  is  less  than  the  straight-line  cost  from  P  to  Q). 

So  it  is  also  true  that  I(PX)l/r  +  !(XQ)l/r  <,  IPQl/r.  Now  VR  and  S,  the  Euclidean  distance  between  R  and 
S  is  less  than  or  equal  to  the  distance  along  any  general  path  between  R  and  S.  So  l(PX)i/r  2:  IPXI/r  ana 
l(XQ)l/r  IXQl/r.  (By  the  notational  convention  that  i(RS)l  is  the  weighted  distance,  or  cost,  between  R  taid 
5,  l(RS)l/r  is  the  Euclidean  distance  of  (RS)  if  (RS)  lies  entirely  in  an  area  of  cost  rate  r.)  Therefore  IPXI/r  + 
IXQl/r  ii  tPQyr.  But  since  P,  X,  and  Q  arc  net  collinear,  this  violates  the  triangie  inequality,  so  case  1  is  not 
possible. 

It  is  dear,  by  example,  that  case  2  is  possible.  Consider  X  coincident  with  the  comer  of  a  rectancnlar 
obstacle  Q,  with  P  and  Q  not  intervisible,  but  closer  to  X  than  to  any  other  vertex  of  O.  (PX  XQ) (PQ)*  in 
this  case,  demonstrating  that  case  2  is  possible,  i.e.,  that  optimal  paths  may  turn  at  terrain-feature  vertices. 


153 


Assume  case  3.  Let  Y  be  the  point  at  which  (XQ)  crosses  the  edge.  Then  by  the  same  reasoning  as  for 
case  1  above,  it  is  contradicted  that  P,  X,  and  Y  are  not  collinear,  i.e.,  X  is  not  a  turn-point,  so  case  3  is  not 
possible. 

Richbourg  [Ref.  20]  proves  the  applicability  of  Snell’s  Law  to  describe  the  angles  of  incidence  and  refrac¬ 
tion  of  an  optimal  path  across  an  edge  as  in  case  4,  demonstrating  that  this  case  is  possible,  i.e.,  that  optimal 
paths  may  turn  as  they  cross  terrain-feature  edges. 

Thus  the  only  tum-points  in  optimal  paths  in  terrain  consisting  of  homogeneous-cost  polygons  on  a 
homogeneous-cost  background  are  coincident  with  terrain  feature  vertices  or  edges.  ♦ 

ASSUMPTION  1-3,  General-Position  Assumption:  No  terrain-feature  vertex  or  edge  interior  lies  on  a  non¬ 
trivial  homogeneous-behavior-region  boundary,  i.e.,  a  homogeneous-behavior  boundary  other  than  those  of 
the  homogeneous-behavior  region  of  which  the  vertex  or  edge  is  the  root,  or  the  terrain-feature  edges  inci¬ 
dent  upon  the  vertex  or  edge. 

COROLLARY  I-3.1:There  is  a  unique  optimal  path  from  each  terrain-feature  vertex  and  edge  interior. 

PROOF  1-3.1:  (Proof  by  Contradiction)  Assume  that  there  were  two  optimal  paths  from  a  terrain-feature  ver¬ 
tex  or  edge  interior.  Then  the  vertex  or  edge  would  lie  on  a  non-trivial  boundary,  by  the  definition  of  a  bound¬ 
ary.  But  this  contradicts  Assumption  1-3.  ♦ 

COROLLARY  1-3 2:  There  is  a  unique  homogeneous-behavior  region  root  associated  with  each 
homogeneous-behavior  region,  where  a  region  root  is  the  first  vertex  or  edge  crossed  by  optimal  paths  which 
start  in  the  region. 
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PROOF  1-3.2:  From  the  definition  of  a  homogeneous-behavior  region  as  the  set  of  points  whose  optimal  paths 
to  a  goal  point  have  the  same  path  list,  the  path  lists  from  all  start-points  in  a  region  are  identical,  so  the  first 
elements  of  the  path  lists  are  also  identical.  Thus  there  is  only  one  root  per  homogeneous-behavior  region.  As¬ 
sume  there  existed  two  homogeneous-behavior  regions  which  shared  the  same  root  Since  a  region  consists  of 
all  points  with  identical  optimal-path  lists,  then  30PLi  =  [EiIResti]  and30PL2  =  [EiIRest2]  such  that  Resti 
Resta.  By  the  definition  of  a  boundary,  Ei  would  thus  be  on  the  boundary  between  region  1  and  region  2. 
By  Theorem  1-2,  Ei  must  be  a  terrain-feature  vertex  or  edge,  but  this  contradicts  the  general-position  assump¬ 
tion.  Thus  there  is  only  one  homogeneous-behavior  region  per  root.  ♦ 

DEFINITION  I-3-3:A  region  R  is  star-shaped  if  3P£  R  such  that  VQe  RandVXe  PQ,  Xe  R. 

COROLLARY  I-3.4:Homogeneous-behavior  regions  are  star-shaped  with  respect  to  their  region  roots. 

PROOF  1-3.4:  By  the  definition  of  a  homogeneous-behavior  region,  all  start-points  in  the  region  have  the 
same  optimal-path  list,  with,  by  the  definition  of  a  region  root,  the  same  first  clement  By  Theorem  1-2,  the 
optimal  path  from  each  start-point  to  the  root  is  a  straight  line  segment  By  the  Theorem  1-1 ,  all  points  along 
the  line  segment  have  optimal  paths  lying  along  the  line  segment  so  sharing  the  first  element  of  their  optimal- 
-  path  lists  as  well,  and  so  by  Corollary  1-3. 1  sharing  optimal-path  lists.  Thus  all  points  along  each  such  line  seg¬ 
ment  lie  in  the  same  homogeneous-behavior  region.  ♦ 

THEOREM  1-4:  Given  a  two-dimensional  map  of  a  finite  number  of  linear  and  polygonal  terrain  features 
and  a  goal-point  it  has  a  unique  optimal-path  tree. 

•*  PROOF  I-4:Given  a  two-dimensional  map  M  of  linear  and  polygonal  terrain  features  and  a  goal  G,  each  point 
S  in  M  either  has  an  optimal  path,  i.e.,  the  feasible  path  of  minimum  cost  or  else  has  no  feasible  path  to  G.  If 
it  tea*  an  optimal  path,  th«n  hy  th«  definition  of  an  optimal-path  List  and  Theorem  I-?.,  j?  also  ha?  an  optimal- 
path  list  If  it  has  no  feasible  path,  it  is  associated  by  convention  with  the  optimal-path  list  (Q,GJ,  where  0  rep¬ 
resents  the  null  list  Define  the  relation  R  =  {(P1P2)  I  OPL(Pt)  =  OPL(P2)} ,  i.e.,  two  points  are  related  by  R 
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if  and  only  if  their  optimal-path  lists  are  identical.  Since  identity  is  an  equivalence  relation,  so  is  R,  so  R  com¬ 
pletely  partitions  the  plane  into  sets  of  points  with  identical  optimal-path  lists.  Since  this  is  the  definition  of  a 
homogeneous-behavior  region,  the  plane  is  completely  partitioned  into  homogeneous-behavior  regions.  Since 
there  are  a  finite  number  of  terrain-feature  vertices  and  edges,  there  are  a  finite  number  of  homogeneous-be¬ 
havior  regions. 

A  directed  acyclic  graph  can  be  used  to  represent  a  partial  order  ar..jng  its  nodes  [Ref.  36].  A  partial  order 
of  a  set  S  is  a  binary  relation  U  such  thatV  a  e  S,  aUa  is  false ,  i.e.,  U  is  irreflexive,  and  Va,  b,  and  c  e  S , 
if  aUb  and  bUc,  then  aUc ,  i.e„  U  is  transitive.  [Ref.  36]  The  set  of  all  homogeneous-behavior  regions  in  map 
M  is  partially  ordered  by  their  optimal-path  lists  as  follows.  Let  U  =  {(Pi  J*2)  I  Pi  CP2} ,  i.e,  optimal-path  list 
P*  precedes  optimal-path  listP2  in  the  partial  order  if  Pi  is  a  proper  subset  of  P2.  Because  the  relation  "proper 
subset”  induces  a  partial  order  on  a  set  whose  elements  are  sets,  the  relation  U  also  induces  a  partial  order  on 
the  set  of  optimal-path  lists,  and  hence  on  the  set  of  homogeneous-behavior  regions,  of  map  M  with  respect 
to  goal  G.  In  fact,  because  of  the  uniqueness  of  optimal-path  lists  from  region  roots,  a  specialization  of  the 
directed  acyclic  graph,  the  tree,  may  be  used  to  represent  the  partial  order  of  homogeneous-behavior  regions. 
We  call  this  tree  an  optimal-path  tree,  because  it  represents  the  optimal  paths  of  map  M. 

Now  consider  the  homogeneous-behavior  regions  in  M  with  optimal-path  lists  consisting  of  only  one  ele¬ 
ment  Since  all  optimal-path  lirts  for  optimal  paths  to  G  have  by  definition  the  point  G  as  their  last  point,  and 
by  the  definition  of  homogeneous-behavior  regions  as  the  set  of  points  with  identical  optimal-path  lists,  there 
is  only  one  region  with  a  single  element  in  its  optimal-path  list,  the  region  with  the  optimal-path  list  [G],  and 
[G]  is  a  subset  of  all  other  optimal-path  lists.  Thus  [G]  precedes  all  other  optimal-path  lists  in  the  partial  order, 
and  so  is  the  root  of  optimal-path  tree  Tm.g,  the  optimal-path  tree  associated  with  map  M  with  respect  to  goal 
point  G.  ♦ 
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D.  PROOFS  FOR  BASIC  BOUNDARY  EQUATIONS 


THEOREM  V-0.1:  (Boundary  between  two  regions  with  taths  which  go  initially  to  two  different  points) 
Given  goal  point  G  and  two  adjacent  homogeneous-behavior  regions  of  cost  rate  r  whose  region  roots  axe 
points  Vi  and  V2,  costs  ci  =  !(ViG)*l  and  C2  =  l(V2G)*l  (the  costs  of  optimal  paths  from  Vi  and  V2  respec¬ 
tively)  where  without  loss  of  generality  it  is  assumed  that  C2  >  ci,  the  boundary  between  regions  1  and  2  is  a 
portion  of  the  hyperbola  branch  which  is  closer  to  V2  than  to  Vi,  and  is  described  by 

(Equation  1)  x2  y2  2 

~2  "T2  =  c 

a  b 

where  a  =  (C2  -  ci)/2,  c  =  r  d(V  1  ,V2),  and  b2  =  c2  -  a2,  and  where  the  x-axis  is  oriented  along  the  line  segment 
V1V2  with  the  origin  at  a  point  half-way  between  V;  and  V2 . 

PROOF  V-0.1:  (See  Figure  37.)  By  the  definition  of  a  homogeneous-behavior  region,  points  in  region  1  all 
have  the  same  path  list,  whose  first  element  is  Vi.  Thus  the  first  leg  of  an  optimal  path  from  any  point  P  in 
region  1  is  PVi.  Similarly,  the  first  leg  from  any  point  P  in  region  2  is  PV2.  The  boundary  between  regions  1 
and  2  is  the  set  of  points  P  such  that  ci  +  DPVjl  =  C2  +  IPV2I.  Therefore  IPVjl  -  IPV2I  =  C2  -  ci.  From  basic 
analytical  geometry,  the  set  of  points  with  constant  absolute  difference  of  distances  from  two  foci  is  a  hyper¬ 
bola.  Since  the  above  equation  describes  the  signed  difference  of  the  two  distances,  it  represents  one  branch 
of  the  hyperbola,  the  branch  such  that  iPVil  >  PV2I.  Thus  the  branch  on  which  P  lies  is  closer  to  V2  (the  ver¬ 
tex  with  the  higher-cost  optimal  path)  than  to  Vi.  ♦ 

THEOREM  V-0.2:  (Boundary  between  a  region  with  paths  which  go  initially  to  a  point,  and  a  region  with 
paths  which  go  to  and  travel  along  a  linearly-traversed-edge,  or  "road")  Given  goal  point  G  and  two  adjacent 
homogeneous-behavior  regions  with  cost-rate  ro,  one  region  having  point  U  as  root  and  the  other  having  linear¬ 
ly-traversed  edge  VW  as  root,  where  VW  is  a  sub-segment  of  some  terrain-feature  edge  such  that  OPL(V)  = 
[W  l  OPL(W)]  and  the  cost-rate  along  the  edge  is  rVw,  (for  example,  a  road  segment  where  paths  leave  the  road 
from  point  W),  the  boundary  between  them  is  a  portion  of  the  curve 
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(Equation  2) 


y2  =  4px, 

where  p  is  defined  as  follows.  From  W  extend  a  ray  WWd  away  from  region  2  (i.e.,  no  point  on  WWd  lies  in 
region  2)  such  that  ZV WWd  =  7t/2  +  and  the  distance  between  W  and  Wd  is  (cw  -  cu)Ao.  Let  point  Ud  be 
the  point  such  that  line  UUd  is  parallel  to  WWd,  and  the  line  UdWd  is  perpendicular  to  line  UUd.  Let  point  O 
be  the  point  on  line  UUd  equidistant  between  U  and  Ud.  Then  the  coordinate  axes  are  the  line  UUd  (x-axis  with 
U  in  the  positive  x  direction)  and  the  line  through  0  parallel  to  UdWd  (y-axis  with  Wd  in  negative  y  direction), 
and  p  =  (cw  -  Cu)Ad  ,  where  \\f  =  sin'Vvw/ro)  is  the  critical  angle,  cw  =  l(WG)*l,  and  cu  =  l(UG)*l  (the  costs 
of  optimal  paths  to  goal  point  G  from  W  and  U  respectively).  Note  that  the  x-axis  is  the  parabola  axis  and  the 
line  UdWd  is  the  directrix. 

PROOF  V-0.2:  (See  Figure  38.)  The  boundary  between  regions  1  and  2  is  the  set  of  points  P  such  that  the 
cost  of  optimal  paths  which  go  through  U  and  through  W  are  the  same.  The  optimal  path  through  U  begins 
with  the  line  segment  PU  and  continues  with  (UG)*  and  has  total  cost  Ca,  while  the  optimal  path  through  W 
starts  with  the  line  segment  PQ  at  cost-rate  id,  where  Q  is  a  point  on  VW  between  V  and  W  inclusive,  con¬ 
tinues  along  line  segment  QW  at  cost-rate  rvw,  and  ends  with  path  (W G)*  with  total  cost  cw.  Thus,  the  bound¬ 
ary  is  described  by  the  equation  ro  d(P,U)  +  cu  =  ro  d(P,Q)  +  rv*d(Q,W)  +  cw,  or  rearranging  terms,  d(P,U)  = 
d(P,Q)  +  sin\|t  d(Q,W)  +  (cw  -  cu)/ro .  Now  ZPQW  =  71/2  +  Y  for  a  road,  as  shown  by  Rowe  [Ref.  2].  Ex¬ 
tending  the  line  PQ  to  point  Pd,  as  Figure  38  shows,  the  right-hand  side  of  the  above  equation  is  the  straight- 
line  distance  from  P  to  Pd .  Let  line  D  lie  perpendicular  to  PQ,  through  Pd.  By  Figure  38,  line  D  is  a  distance 
(cw  -  cu)Ad  from  W.  Thus,  the  above  equation  states  that  P  is  equidistant  from  point  U  and  line  D,  the  defini¬ 
tion  of  a  parabola  with  the  form  of  Equation  2,  where  the  coordinate  axes  are  the  lines  UUd  and  D  as  shown, 
and  p  is  half  the  distance  from  U  to  Ud.  ♦ 

THEOREM  V-0  3:(Boundary  between  regions  having  paths  which  go  to  and  travel  along  two  different  linear¬ 
ly-traversed  edges,  or  "roads”)  Given  goal  point  G  and  two  adjacent  homogeneous-behavior  regions  with  cost- 
rate  id,  one  region  having  linearly-traversed  edgeXYasrootandthe  other  having  linearly- traversed  edge  VW 
as  root,  where  XY  and  VW  are  sub-segments  of  terrain-feature  edges  such  that  OPL(X)  =  [Y  i  OPL(Y)], 
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Figure  38 

Boundary  Between  Homogeneous-Behavior  Regions  with  a 
Linearly-Traversed  Root  and  a  Point  Root 
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OPL(V)  =  [W  I  OPL(W)]  and  the  cost-rates  along  the  edges  are  rxy  and  rvw  respectively,  (for  example,  two 
road  segments  where  paths  leave  road  XY  from  point  Y  or  leave  road  VW  at  point  W),  the  boundary  between 
them  is  a  segment  of  line  L  defined  as  follows.  Let  Dxy  be  the  line  which  forms  angle  \{/Xy  with  line  XY,  is 
distance  Cy  from  point  Y,  and  lies  on  the  side  of  XY  which  does  not  include  the  region  of  which  XY  is  the 
root  Let  Dvw  be  the  line  which  forms  angle  \|/Vw  with  line  VW,  is  distance  cw  from  point  W,  and  lies  on  the 
side  of  VW  which  does  not  include  the  region  of  which  VW  is  the  root.  Let  Pb  be  the  point  of  intersection  of 
Dxy  and  Dvw,  and  let  a  be  the  angle  between  line  XY  and  line  VW.  Then  the  boundary  lies  on  line  L,  which 
is  the  line  through  point  Po  which  lies  at  an  angle  (a  +  t|Tvw  +  \|/Xy)/2  with  both  Dxy  and  Dvw. 

PROOF  V-0  J:(See  Figure  39)  Consider  the  set  of  points  P  with  two  optimal  paths,  OPLi  =  [Qi,  Y I  OPL(Y)], 
and  OPL2  =  [Q2,  W I  OPL(W)],  where  Qi  and  Q2  are  the  points  at  which  the  paths  first  enter  edges  XY  and 
VW  respectively.  The  cost  of  OPLi  is  no  d(P,Qi)  +  sin(\(/x>d(Qi,Y)  +  cy  and  the  cost  of  OPL2  is  ro  d(P,Q2)  + 
sin\J/vwd(Qz,W)  +  cw.  By  Figure  39,  these  are  the  perpendicular  distances  of  P  from  two  lines  Dxy  and  Dvw, 
defined  as  follows.  Dxy  is  the  line  which  forms  angle  \|fXy  with  XY,  is  distance  cy  from  point  Y,  and  lies  on 
the  opposite  side  of  XY  from  the  region  of  which  XY  is  the  root  Dvw  is  the  line  which  forms  angle  \|fvw 
with  VW,  is  distance  cw  from  point  W,  and  lies  on  the  opposite  side  of  VW  from  the  region  of  which  VW  is 
the  root  From  analytic  geometry,  a  set  of  points  equidistant  from  two  lines  is  a  line.  The  point  Po,  where  Dxy 
and  Dvw  intersect  is  distance  zero  from  both  lines,  and  so  lies  on  line  L  which  includes  the  boundary.  By  basic 
plane  geometry,  the  line  equidistant  from  two  intersecting  lines  is  the  line  which  bisects  the  angle  between 
them.  The  angle  between  Dxy  and  Dvw  is  (a  +  \jfXy  +  tyvw),  so  that  line  L  forms  angle  (a  -r  \jrXy  +  \|fvw)/2 
with  both  Dxy  and  D  vw»  ♦ 


THEOREM  V-0.4:  (Boundary  between  two  regions  having  paths  which  cross  two  different  edges.)  Given 
goal  point  G  and  two  adjacent  homogeneous-behavior  regions  with  cost-rate  to,  one  region  having  Snell’s- 
Law  edge  VW  and  the  other  having  Snell’s-Law  edge  XY,  where  paths  which  cross  VW  go  directly  to  point 
U  at  cost-rate  rvw,  paths  which  cross  XY  go  directly  to  point  Z  at  cost-rate  rxy,  and  where  the  total  cost  from 
U  to  the  goal  is  cu  and  from  Z  to  the  goal  is  cz,  the  boundary  between  them  consists  of  points  P  such  that  the 
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Figure  39 

Boundary  Between  Homogeneous-Behavior  Regions  with  Two 
Linearly-Traversed  Roots 
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distance  from  P  to  edge  VW  is  X2,  the  distance  from  VW  to  U  is  xi,  the  distance  from  point  P  to  edge  XY  is 
y2,  and  the  distance  from  XY  to  Z  is  y  t,  where  the  seven  equations  of  Equation  Set  4  are  satisfied. 

(Equation  Set  4)  _  di  siny  do  sin  (3 

X1  ~  COS01  ’  ^  ~  COS03 


Boundary  Condition:  rVwXt  +  rox2  =  rxyyt  +  my2 

Snell’s  Law  for  edge  VW:  rvwSinOi  =  rosin02 

Snell’s  Law  for  edge  XY:  rxysin03  =  rosin04 

where  do,  di,  a,  {3,  and y  are  constants  as  shown  in  Figure  40,  xi,  X2,  y  t,  and  y2  are  distances,  and  0t  and  03 
are  the  dependent  and  independent  variables. 

PROOF  V-0.4:  (See  Figure  40.)  Given  two  adjacent  regions  with  point  P  on  their  boundary,  and  given  that 
the  optimal  paths  from  region  1  cross  edge  VW  obeying  Snell’s  Law,  and  then  go  through  point  U  en  route  to 
the  goal,  and  that  optimal  paths  from  region  2  cross  edge  XY  obeying  Snell’s  Law,  and  then  go  through  point 
Z  en  route  to  the  goal,  with  costs  as  shown,  the  boundary  condition  is 

(4-1)  rvwxi  +  rox2  =  rsyyt  +  roy2. 

The  Snell’s-Law  conditions  across  edges  VW  and  XY  are 

(4-2)  rvwsinO  t  =  rosin02  and  rxysin03  =  rosin04 . 
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Figure  40 

Boundary  Between  Homogeneous-Behavior  Regions  Each  with  a 
Snell’s-Law  Edge  as  Root 
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Applying  trigonometric  identities  to  the  triangles  UQiI  and  ZQ2I  gives  the  following  for  xi  and  yi. 


(4-3) 


xi 


dt  sin  y 

COS01 


(4-4)  yi 


dosing 
cos  83  . 


The  law  of  sines  applied  to  AUQtl  gives  that 


(4-5) 


d2 


xi  sin(  81  -  Y; 

sinY 


Substituting  the  expression  for  xi  in  equation  4-3  into  4-5  gives 


(4-6) 


d2 


di  cos(0i  -  Y) 

COS01 


The  law  of  sines  applied  to  AZQ2I  gives 


(4-7)  yi  cos-,03  -  P) 

(13  =  - rf5 — “ 

sinp 

Substituting  for  the  expression  for  yi  in  Equation  4-4  into  4-7  gives 

(4-8)  docos(03-P) 

d!  '  — . 


Applying  trigonometric  identities  to  the  right  triangle  whose  hypotenuse  is  the  line  segment  PQt  gives 
(4-9)  X2COS02  =  -i3sin(X  -  y2cos(04  4  (X) . 


Substituting  the  expression  for  d3  in  Equation  4-8  into  Equation  4-9  gives 


(4-10) 


docos(fe  -  (3)sir>a  _  cos(04  4  a) 

COS03  COS  02  '  COS02 
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Applying  trigonometric  identities  to  the  right  triangle  whose  hypotenuse  is  the  line  segment  PQi  gives 


(4-11)  y2cos04  =  d2sin(X  -  X2cos(02  +  '*X)  • 

Substituting  the  expression  for  d2  in  Equation  4-6  into  Equation  4-11  gives 

(4-12)  _  dicos(0i  -y)sina  cos(02  +  a) 

COS01  COS  04  X2  COS04 

Substituting  the  expression  for  y2  in  Equation  4-12  into  Equation  4-10  and  simplifying  gives 

(4-13) 

X2  = 

Substituting  the  expression  for  X2  in  Equation  4-13  into  Equation  4-12  and  simplifying  gives 

(4-14) 

_  sina. dtcos(0i 
“  sin04'  cos0i 

Equations  4-1, 4-2, 4-3, 4-4, 4-13,  and  4-14  are  exactly  Equation  Set  4. 0|  and  03  must  be  iteratively  set  and 
tl>c  results  of  the  first  four  equations  checked  in  the  boundary-condition  equation,  since  there  is  no  known 
closed  form  for  Equation  Set  4.  The  angles  02  and  04  arc  determined  by  the  Snell’s  Law  relations.  ♦ 


docos(03  ■ 

COS(02  +  (X),  COS02 
COS02  '  J 


5)  dicos(0i  -  Y)cos(04  +  a) 
COS0ICOS04  '' 
cos(02 + a)cos(04 + a) 1 
COS  02  COS04. 


sin(Xcos(03  -  p)  dicos(0i  -  V)cos  (04  +  (X) 

COS02  COS03  '  COS0)  COS04 

~  (cos(02  +  (X)  COS(04  +  a)  . 

(  1  •  - COS02  COS04 -  ) 


THEOREM  V-0.5 ‘.(Boundary  between  a  region  with  paths  which  go  to  and  travel  along  a  linearly-traversed 
edge  ("road")  and  a  region  withpathswhich  cross  an  edge)  Given  goal  pointG  and  two  adjacent  homogeneous- 
behavior  regions  with  cost- rate  ro,  one  region  having  linearly  -traversed  edge  VW  as  root,  and  the  other  having 
as  root  Snell's-Law  edge  XY,  where  VW  is  a  sub-segment  of  some  terrain-feature  edge  such  that  OPL(V)  = 
[W 1  OPL(W)l  and  the  cost-rate  along  the  edge  is  rvw,  (for  example,  a  road  segment  where  paths  leave  the  road 
from  point  W)tai:d  where  paths  which  cross  XY  go  directly  to  point  Z  at  cost-rate  rXy,  and  where  the  total  cost 
from  W  to  the  goal  is  c^,  and  from  Z  to  the  goal  is  c&  The  boundary  between  the  regions  consists  of  points  P 
such  that  the  six  equations  of  Equation  Set  5  are  satisfied. 


(Equation  Set  5) 


d?  sin  [3 
cos&t 


yi  =xi 


sing 

costfc 


x2 


cos(u>+  a) 
cos02 


+  d2 


sinY 

COS02 


d2(cos(92  +  YOCrosing  -  rVwCos82)  +  rosiny  cos(G2  -  a)) _ 

sin(02-cx-y)rv>icos82-!  rocos(02  -  a)(sLn(02-a-Y)+ro(cosB2+cos(82  -  a))) 

d3cos82(msinacos^i-  rXysin3cos(92  -a))  (cz-  cw)cos82co.s0ir-  a) 
sin(02  a-\{/)rvvkCOs82+rocos(82  -  a)(sin(82-a-\}/)+rc(cos82-H:cs(82  -  a))) 


_  D) W2cos(6;tY)«licospcosez) 

dzrosinyr-  d3( — rxysinPcos02)  +  (Ca-  -  cw)cos02 


Snell's  Law  condition  forcdgcXY:  rxy  sinSi  =  rosin02 


Snell’s  Law  condition  for  edge  VW:  sin\|/=  r«u-  /  ro 
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PROOF  V-0.5:(See  Figure  4 1 .)  Given  two  adjacent  regions  with  point  P  on  their  boundary,  and  given  that 
the  optimal  paths  from  region  1  go  directly  to  edge  VW  and  travel  along  it  to  point  W,  and  that  optimal  paths 
from  region  2  cross  edge  XY  obeying  Snell’s  Law,  and  then  go  through  point  Z  en  route  to  the  goal,  with  costs 
as  shown  in  Figure  41,  the  boundary  condition  is 


Crj'2 + rxyy  t  -f-  Cz  =  crX2  +  rvwxi + cw  - 


At  the  two  edges,  the  Snell’s-Law  conditions  are 

Cvsin0;  =  rxysin0i 

and  sin\y=rvw/cr  . 

The  same  type  of  trigonometric  and  algebraic  reasoning  used  in  Proof  V-0.4  leads  to  the  equations  listed  in 
Equation  Set  5.  Since  there  is  no  closed-form  expression  for  the  boundary,  an  approximation  is  computed  using 
a  Finite  number  of  points.  The  procedure  for  plotting  a  point  on  the  boundary  is  to  set  9i,  usethcfirstSnell’s- 
Law  condition  to  solve  for  02,  and  then  solve  for  xi  and  X2.  ♦ 

THEOREM  V-0.6:  ( Boundary  between  t wo  regions  each  having  paths  which  cross  two  edges)  Given  goal 
point  G  and  two  adjacent  homogeneous-behavior  regions  with  cost-rate  rc,  one  region  having  Sncll’s-Law 
edge  VW  and  the  other  having  SnclPs-Law  edge  RS,  where  paths  which  cross  VW  go  from  there  at  cost-rate 
rvw  directly  to  a  SnclPs-Law  crossing  at  edge  XY,  and  then  go  at  cost-rate  rxy  directly  to  point  Zu  paths  which 
cross  RS  go  from  there  at  cost-rate  rrj  directly  to  a  Snell ’s-Law  crossing  at  edge  TU,  and  then  go  at  cost-rate 
rlu  directly  to  point  Z2,  and  where  total  cost  from  Zj  to  the  goal  is  ci  and  from  Z2  to  the  goal  is  C2,  the  bound¬ 
ary  between  them  consists  of  points  P  such  that  the  path  distance  from  P  to  edge  VW  is  y3,  the  path  distance 
from  VW  to  X  Y  is  >7,  the  path  distance  from  XY  to  point  P  is  yi,  the  path  distance  from  point  P  to  edge  RS 
is  X3,  the  path  distance  from  RS  to  TU  is  x 2,  and  the  path  distance-  from  TU  to  Z2  is  xi,  where  the  fourteen 
equations  of  Equation  Set  6  are  satisfied. 
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Figure  41 

Boundary  Between  Homogeneous-Behavior  Regions  with  a  Snell’s-Law 
Edge  and  a  Linearly-Traversed  Edge  as  Roots 
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(Equation  Set  6)  ..  d7  sin0i 

X1  =  "cosW  ’ 


yi 


ds  sin  Pi 
COS01  * 


X2 


sin03 

COS06 


(d4  - 


d7COS(p2  -  08)v 

COS08 


,  y2  = 


slnOCi ,  . 


d5cos(Bi  -  6j\ 
cosdi  ’ ’ 


Sin(CX3  +  Yl)  /  J  d4COS07  d7COS(p2  -  6g)cos07 
X3  ~  '  cos(05  +  CU  +  yiy  3  sin06  cosUi  ’ ’ 


y3 


sinYi  ,  .  dicos02 

COS(04  -  7l)  2  ’  COS03 


.  d5COS(3l  -  0l)cos02  x 
+ - - > 


cos(04-Yl) 
cos(05  +  0C4  +  Yl) 


d3  - 


d3  - 


d4  COS07 
sin06 

d4  COS07 

sin06 


d5COS(p2  -  08)cos04 
+  COS08  ' 

t  d7COS(32-08)COS07~ 
COS08 


Boundary  Condition: 
Snell’s  Law: 


roy3  +  rVwy2  +  rxyyi  =  rox3  +  irsX2  +  rwxi 

rvwsin02  =  rxysin0i  rosin04  =  rVwsin03 
rrjsin07  =  rtu3in08  rosinQs  =  rr*sin06 


Trigonometric  Identities:  03  =  at  -  02 


06  =  CC3  -  07 


PROOF  V-0.6:  (See  Figure  42.)  Given  two  adjacent  regions  with  point  P  on  their  boundary,  and  given  that 
the  optimal  paths  from  region  1  cross  edge  VW  obeying  Snell’s  Law,  then  go  straight  to  edge  XY  and  cross 
it  obeying  Snell’s  Law,  and  then  go  through  point  Zi  en  route  to  the  goal,  and  that  optima!  paths  from  region 
2  cross  edge  RS  obeying  Snell’s  Law,  then  go  straight  to  edge  TU  and  cross  it  obeying  Snell’s  Law,  and  then 
go  through  point  Z2  en  route  to  Urn  °oal,  with  costs  as  shown  in  Figure  42,  the  boundary  condition  is 


roy3  +  rVw>’2  +  rxyyi  =  rox3  +  rrsX2  +  rtuxi. 
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Figure  42 

Boundary  Between  Homogeneous-Behavior  Regions  each  with  Two 
Snell’s-Law  Edges  as  Roots 
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At  each  edge,  the  Sncll’s-Law  conditions  are 


rVwSin02  =  lxysinGi 

rosin04  =  rVwsin03 
rnsin07  =  rwsin93 
rosin05  =  rrssin06. 

Trigonometric  identities  applied  to  AV1P1P2  and  AV2P3P4  give  the  relations 

03  =  ££i  -  02  and 
06=Ct3*07  . 


Applying  to  tile  diagram  of  Figure  42  the  same  type  of  trigonometric  and  algebraic  reasoning  used  in  Proof 
V-0.4  leads  to  die  equations  listed  in  Equation  Set  6.  By  solving  for  0 1  and  08,  a  point  P  on  the  boundary  can 
be  found.  Since  there  is  no  closed-form  expression  for  the  boundary,  an  approximation  is  used  where  a  finite 
number  of  points  are  plotted.  Since  there  is  no  closed-form  expression  for  0g  as  a  function  of  0i,  the  proce¬ 
dure  for  plotting  a  point  on  the  boundary  is  to  set  0 1 ,  iteratively  search  for  a  value  of  08  for  which  the  equa¬ 
tions  of  Equation  Set  6  are  satisfied  (within  some  allowable  error),  and  then  trace  the  Sncll’s-Law  path  accord¬ 
ing  to  the  heading  for  9i  using  the  values  for  yt,  y2.  and  y3,  or  according  to  the  heading  for  08  using  the 
values  for  xi,  X2,  and  X3.  Note  also  that  the  expression  for  Ji  is  not  in  closed  form,  and  so  must  be  found  by 
iterative  means.  ♦ 
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E.  PROOFS  FOR  BOUNDARIES  ASSOCIATED  WITH  PRIMITIVE  TERRAIN-FEATURE 


TYPES 

LEMMA  V-1.1:  If  there  are  feasible  paths  from  a  vertex  of  a  polygonal  obstacle,  then  the  obstacle  edges  con¬ 
stitute  boundaries  between  homogeneous-behavior  regions. 

PROOF  V-1.1:  Trivially  true.  4 

LEMMA  V-1.2:  Each  vertex  V  of  an  obstacle  hidden  edge  generates  a  linear  shadow  boundary  which  is  the 
ray  lying  on  the  line  defined  by  V  and  the  first  point  P  on  OPL(V),  starting  at  V  and  lying  in  the  opposite  direc¬ 
tion  from  P. 

PROOF  V-1.2:  Note  that  if  V  joins  a  hidden  edge  and  a  visible  edge,  point  P  will  not  be  on  the  obstacle 
perimeter  by  the  definition  of  a  visible  edge;  if  V  joins  two  hidden  edges,  P  will  be  the  other  vertex  of  one  of 
the  hidden  edges.  We  prove  first  that  there  is  a  single  shadow  boundary  associated  with  each  hidden-edge  ver¬ 
tex,  second  that  no  vertices  other  than  hidden-edge  vertices  generate  shadow  boundaries,  and  third,  that  the 
shadow  boundary  is  a  ray  defined  as  stated  in  Lemma  V-1.2. 

First,  consider  point  Q  near  V,  a  hidden-edge  vertex.  Let  P  be  the  first  point  on  OPL(V).  Then  one  of 
three  cases  holds  (sec  Figure  43):  either  (a)  Q»  is  in  the  obstacle  interior,  or  (b)  Qb  and  P  are  intervisible,  or 
(c)  Qc  and  P  arc  not  intervisible.  Clearly,  if  V  joins  a  hidden  and  a  visible  edge,  Figure  43a  applies,  and  if  V 
joins  two  hidden  edges,  Figure  43b  applies.  Q*  is  separated  from  Qb  and  Qc,  not  by  shadow  boundaries,  but 
by  obstacle-edge  boundaries.  The  optimal  path  from  Qb  is  (QbG)*  =  ((QbP)*  (PG)*),  where  (QbP)*  is  the  line 
segment  PQb.  Thus  the  optimal-path  list  from  Qb  is  OPL(Qb)  =  [P I  OPL(P)].  The  optimal  path  from  Qc  is 
OPL(QcG)*  =  ((QcV)*(VP)*(PG)*),  where  (QcV)*  and  (VP)*  arc  the  line  segments  VQC  and  VP  respective¬ 
ly.  Thus  the  optimal-path  list  from  Qc  is  OPL(Qc)  =  [V,  P 1  OPL(P)].  Thus  OPL(Qb)  ^OPL(Qb),  so  Qb  and 
Qc  are  in  different  regions,  so  there  is  a  boundary  between  them. 

Wc  show  secondly  that  no  other  vertices  gcnerac  shadow  boundaries.  Assume  vertex  V  docs  not  join  a 
hidden  and  a  visible  edge,  or  two  hidden  edges.  Then  it  joins  two  visible  edges.  Thus,  OPL(V)  docs  not  in- 
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Figure  43 

Obstacle  Shadow  Boundaries 
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elude  any  vertices  of  the  obstacle,  from  the  definition  of  a  visible  edge.  By  Assumption  1-3,  V  is  not  on  a  non¬ 
trivial  (i.c.,  non-obstacle-edge)  boundary.  Consider  a  point  Q  arbitrarily  close  to  V.  Clearly,  Q  is  either  in  the 
obstacle  interior  (call  it  Qa)  or  in  its  exterior  (including  its  edges)  (call  it  Qb).  Clearly,  Qi  is  separated  from  Qb 
by  an  obstacle-edge  boundary.  Now  in  the  absence  of  externally-generated  boundaries  in  the  vicinity  of  Vi, 
Qb  can  be  made  close  enough  to  V  that  it  is  in  the  same  region  as  V,  and  so  OPL(V)  =  OPL(Qb).  Thus  in  the 
vicinity  of  V,  there  is  only  one  exterior  region,  and  so  V  does  not  generate  any  shadow  boundaries. 

Thirdly,  we  show  that  each  shadow  boundary  is  a  ray  lying  on  the  line  defined  by  vertex  V  and  P,  the  first 
point  on  OPL(V),  starting  at  V  and  lying  away  from  P.  Consider  a  point  R  on  ray  B  in  Figure  43a  or  43b.  By 
convention,  let  points  on  B  not  be  intcrvisible  with  P.  Then  (RP)*  =  (RV  VP).  Now  consider  Rr  arbitrarily 
close  to  R  but  intervisible  with  P.  By  the  definition  of  intervisibility,  (R'P)*  is  a  straight-line  segment.  Since 
R'  is  arbitrarily  close  to  P,  (R'P)*  must  be  arbitrarily  close  to  (RV  VP) ,  and  so  (RV  VP)  must  be  a  straight- 
line  segment,  collincar  with  P,  V,  and  R.  Since  B  separates  the  region  with  OPL  =  [V,  P I  OPL(P)]  from  the 
region  with  OPL  =  [P I  OPL(P)],  B  must  begin  at  V  and  lie  away  from  P.  ♦ 

LEMMA  V-1.3:  A  convex  polygonal  obstacle  has  exactly  one  opposite  edge. 

PROOF  V-1.3:First,  we  show  that  obstacle  0  with  n  distinct  vertices  has  at  least  one  opposite  edge.  Assume 
O  in  Figure  44a  has  no  opposite  edge.  Then  for  any  hidden  edge  ViVi+i,  either  OPL(Vi)  COPL(Vi+i),  or 
OPL(Vj+i)  c  OPL(V,),  or  else  ViVj+j  would  be  an  opposite  edge.  Now  consider  vertex  Vi,  a  vertex  joining 
a  hidden  and  a  visible  edge.  By  the  definition  of  visible  edges,  Vv*  e  0,  Vj{<£  OPL(Vi).  Therefore,  it 
must  be  that  0PL(V2)  <Z  OPL(Vi).  Since  V1V2  is  not  an  opposite  edge,  OPL(Vi)  C  OPL(Vz).  Then  by  in¬ 
duction  on  i,  similar  reasoning  shows  that  Vi,  OPL(Vi)  COPL(Vi+i).  For  i  =  n,  similar  reasoning  shows  that 
OPL(Vn)  cOPL(Vi).  But  this  statement  contradicts  that  VVkS  0,  Vk  e  OPL(Vi).  Therefore  by  con¬ 
tradiction,  obstacle  0  has  at  least  one  opposite  edge. 

Now  assume  that  there  arc  n  distinct  opposite  edges,  where  n>2.  Choose  any  two  opposite  edges,  say 
V|V,+i  and  VjVj+i,  and  without  loss  of  generality  assume  that  j  >i+l  as  shown  in  Figure  44b.  Since  VtVi+i 
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is  an  opposite  edge,  Vi  £  OPL(Vi+i).  Therefore  OPL(Vi+i)  C  OPL(Vj)  and  OPL(Vi+i)  C  OPL(Vj+i).  By 
similar  reasoning  with  respect  to  edge  VjVj+i,  OPL(Vj+i)  c  OPL(Vi)  and  OPL(Vj+i)  cOPL(Vi+i).  But 
this  is  a  contradiction,  so  there  must  be  no  more  than  one  opposite  edge. 

Therefore  a  convex  polygonal  obstacle  has  exactly  one  opposite  edge.  ♦ 

LEMMA  V-1.4:  An  opposite-edge  boundary  emanates  from  each  obstacle  opposite  edge  and  consists  of  seg¬ 
ments  of  hyperbolas  such  that  an  initial  hyperbola  segment  starts  at  the  opposite  point  and  is  defined  by  con¬ 
sidering  the  vertices  Vi  and  V2  of  the  opposite  edge  as  its  foci,  with  hyperbolic  constant  being  the  absolute 
value  of  the  difference  of  the  costs  of  (ViG)*  and  (V2G)*,  as  specified  in  Equation  1 .  If  at  any  point  a  shadow 
boundary  intersects  the  opposite-edge  boundary,  it  will  continue  along  a  new  hyperbola  segment  defined  by 
considering  as  foci,  first,  the  vertex  of  the  edge  which  generated  the  shadow  boundary  and  which  is  closer  to 
the  goal  of  the  two  vertices  of  that  edge,  and  second,  the  focus  of  the  previous  hyperbola  which  is  not  also  a 
vertex  of  the  edge  which  generated  the  shadow. 

PROOF  V-1.4:  Given  a  convex  polygonal  obstacle  O  with  opposite  edge  V1V2,  and  given  point  X  on  V1V2 
such  that  3(XG)i*  and  (XG)2*,  (XG)t*  *  (XG)2*.  i.e.,  X  is  the  opposite  point  Since  V1V2  is  a  hidden  edge, 
then  it  must  be  that  OPLi(X)  =  [Vi !  OPL(Vt)]  and  OPL>.(X)  =  [V2  !  OPL(V2)]  (see  Figure  45a).  Consider 
point  P  arbitrarily  close  to  X  in  the  obstacle  exterior.  By  Theorem  1-2,  (PVt)*  =  IPVil  and  (PV2)*  =  IPV2i,  be¬ 
cause  no  other  terrain  features  intervene,  so  P  is  in  both  the  homogeneous-behavior  region  with  V 1  as  root  and 
the  region  with  V2  as  root.  By  Theorem  V-0.1 ,  the  set  of  points  P  is  described  by  Equation  1 . 

Let  Bt  be  the  set  of  points  over  which  P  obeys  die  Equation  1.  As  ?  moves  away  from  X,  it  lies  on  Bi 
only  as  long  as  PVj  C  (PG)i*  and  PV2C  (PG)2*,  i.c„  as  long  as  the  line  segment  from  P  to  both  vertices  arc 
par;  of  the  respective  optimal  paths  from  P  in  the  two  directions.  If  at  some  point  Z  it  becomes  true  that  PV* 
<Z  (PC);*,  for  5=1  or  i=2,  then  at  that  point  Bi  must  have  intersected  shadow  boundary  i  (see  Figure  45b). 
Now  the  same  reasoning  as  above  applies  to  the  point  V*.  where  OPL(Vi)  =  [  Vk  I  OPL(V*)l,  and  so  another 
hyperbola  branch  B2  becomes  the  adjoining  portion  of  the  opposite-edge  boundary .  Since  point  Z  lay  on  both 
hyperbola  branches  Bi  and  B; ,  it  must  be  that  Bi  and  B:  intersect  at  point  Z.  The  same  reasoning  continues 
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Figure  45 

Obstacle  Opposite-Edge  Boundary 


to  apply  as  long  as  Bj  intersects  any  shadow  boundary  of  obstacle  O.  Therefore  the  opposite-edge  boundary 
is  a  connected  sequence  of  hyperbola  segments  starting  at  the  opposite  point,  and  for  each  segment  consisting 
of  a  portion  of  the  hyperbola  branch  with  the  two  visible  obstacle  vertices  as  foci  and  the  hyperbolic  constant 
being  c2-ct,  where  C2>ci.  ♦ 

THEOREM  V-l :  A  convex  polygonal  obstacle  in  homogeneous  background  terrain  with  specified  goal-point 
will  generate  as  boundaries  the  obstacle  edges,  shadow  boundaries  from  each  vertex  of  a  hidden  edge  as 
specified  in  Lemma  V-l  ,2,  and  a  single  opposite-edge  boundary  consisting  of  piecewise  hyperbolic  segments 
as  specified  in  Lemma  V-1.4. 

PROOF  V-l:  Theorem  V-l  follows  directly  from  Lemma  V-l.l,  Lemma  V-1.2,  and  Lemma  V-1.4. 

LEMMA  V-2.1:  A  river  segment,  or  river-edge,  constitutes  a  boundary  between  regions. 

PROOF  V-2.1:  (Sec  Figure  46a.)  Given  river  segment  V1V2.  and  point  Xi  arbitrarily  close  to  V1V2  having 
optimal-path  listOPL(Xi)  =  [W I  OPL(W)j  where  W  €  V1V2, i.e.,Xj’s optimal  path  does  notcrosstheriver, 
and  point  X2  arbitrarily  close  to  Vi  V2  on  the  opposite  side  Vi  V2 .  Now  X2  may  have  one  of  three  possible  op¬ 
timal-path  lists:  OPLi  (X2 )  =  [Vi  I  OPL{Vi)]  i.e.,  it  goes  around  end  1  of  the  river,  or  OPLb(X2)  =  [V2  I 
OPL(V2)],  i.c.,  it  goes  around  end  2  of  the  river,  or  OPLc(X2)  «  [[V1V2]  I  OPL(W)]  where  [V1V2]  specifies 
that  the  path  crosses  the  river  without  changing  direction,  and  W  is  the  next  point  on  the  optimal-path  list. 
Since  in  all  three  cases,  the  optimal-path  list  of  X2  is  different  from  that  of  Xi ,  therefore  Xi  and  X2  arc  in 
different  regions.  Therefore  the  river  edge  constitutes  a  boundary.  ♦ 

LEMMA  V-2.2:  Each  river  vertex  V  with  OPL(V)  =  [W I  OPL(W)]  which  is  an  endpoint  of  a  river  segment 
not  joining  itny  others  will  generate  a  shadow  boundary  which  is  a  ray  lying  on  the  line  VW,  starting  at  V  and 
lying  away  from  W. 
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PROOF  V-2.2:  Given  the  same  situation  as  in  Proof  V-2.1,  analyze  OPL*  (X2  )  =  [Vi  I  OPL(Vt)]  and 
OPLb(X2)  =  [V2 1  OPL(V2)],  with  respect  to  vertices  Vi  and  V2  it;  the  same  manner  as  in  Proof  V- 1.2  to  show 
that  there  are  rays  emanating  from  Vi  and  V2  lying  away  from  the  goal  which  act  as  boundaries  between  op¬ 
timal  paths  which  go  around  the  vertices  and  those  which  bypass  them.  Note  that,  assuming  a  positive  river¬ 
crossing  cost,  location  c  for  X2  will  never  be  such  that  X2 ,  Vi,  and  the  next  point  in  OPLc(Vi)  are  collinear, 
because  if  so,  it  will  be  less  costly  for  the  optimal  path  to  avoid  crossing  the  river  and  go  around  vertex  Vi  in¬ 
stead.  ♦ 

LEMMA  V-2.3:  A  river  segment  with  vertex  V  with  OPL(V)  =  [W I  OPL(W)]  not  adjoining  any  other  river 
segment  may  have  a  rivcr-crossing  boundary  which  is  a  segment  of  one  branch  of  a  hyperbola  constructed  by 
considering  as  foci  the  points  V  and  W,  with  hyperbolic  constant  c  =  IVWI  -  cr,  where  cr  is  the  fixed  river¬ 
crossing  cost.  This  boundary  will  exist  if  the  branch  closer  to  V  intersects  the  river  segment.  The  boundary 
consists  of  the  portion  of  the  hyperbola  branch  between  the  intersection  of  the  branch  with  the  river,  and  the 
first  point  of  intersection  of  the  branch  with  another  river  boundary. 

PROOF  V-2 3:  Consider  point  P  which  lies  in  the  shadow  of  river  segment  with  vertex  V  as  in  Figure  46b, 
where  ro  is  the  cost  rate  for  travel  in  the  background  region.  As  in  Figure  46a,  there  are  only  three  possible 
•  'YS  cnc  optimal  path  from  P  can  go  initially.  If  P  lies  on  a  boundary  between  paths  which  cross  the  river 
p.  j...a  the  fixed  crossing  cost,  and  paths  which  go  through  V,  the  first  region  has  V  as  its  root  and  the  second 
region  has  the  river  segment  as  its  root.  Optimal  paths  crossing  river  segments  do  not  change  headings.  There¬ 
fore,  the  path  from  P  to  W  has  cost  Cpw  =  ro  d(P,W)  +  cr.  The  cost  of  the  path  from  P  to  V  has  cost  Cpv  =  ro 
d(P,V),  as  usual  with  a  point  root,  and  the  cost  cw  from  W  is  known.  But  this  is  just  as  if  paths  in  region  2  had 
W  as  a  root,  where  the  cost  from  W  to  G  was  cw  +  cr.  Thus,  the  boundary  separates  two  regions  whose  roots 
arc  points,  so  by  Theorem  V-0.1 ,  the  boundary  is  a  hyperbola  segment  described  by  Equation  1.  If  cr  and  the 
orientation  of  VVV  are  such  that  the  boundary  docs  not  intersect  the  river  segment  between  V  and  U,  it  must 
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be  that  for  all  points  in  the  shadow  of  the  river  segment,  if  is  more  costly  to  cross  the  river  than  to  go  around 
via  V.  ♦ 

LEMMA  V-2.4:  A  river  segment  with  vertices  Vi  and  V2  has  an  opposite-edg*  boundary  which  lies  on  the 
hyperbola  formed  by  considering  each  vertex  as  a  focus  conforming  to  Equation  1,  and  lies  on  the  branch  of 
the  hyperbola  which  is  closer  to  the  vertex  with  higher-cosi  optimal  path. 

PROOF  V-2.4:  Consider  point  Q  in  Figure  46b.  This  point  is  on  the  boundary  which  separates  region  1  from 
region  3.  Optimal  path  from  Q  through  region  1  goes  through  V,  while  the  optimal  path  through  region  2  goes 
through  U.  Thus,  the  boundary  separates  regions  whose  roots  are  both  points,  so  Theorem  V-O.l  applies.  ♦ 

THEOREM  V-2:  An  isolated  river  segment  has  a  river-edge  boundary,  two  shadow  boundaries  formed  as 
specified  in  Lemma  V-2.2,  an  opposite-edge  boundary  formed  as  specified  in  Lemma  V-2.4,  and  either  two, 
or  no,  river-crossing  boundaries  as  specified  in  Lemma  V-2.3. 

PROOF  V-2:  Consider  points  Xi,  X2,  Vi  and  V2  as  in  Proof  V-2.1  and  Figure  46a,  with  optimal-path  lists 
OPL(Xi),  OPL(X,),OPL(Xb),  andOPL(Xc)  as  described  in  Proof  V-2.1.  Clearly,  these  four  optimal-path  lists 
are  the  only  ones  possible  for  points  arbitrarily  close  to  an  isolated  river  segment,  so  by  the  definition  of  a 
homogeneous-behavior  region,  there  are  no  more  than  four  regions  associated  with  a  river  segment.  Thus  the 
only  boundaries  possible  adjacent  tc  an  isolated  river  segment  arc  those  between  pairs  of  these  four  regions, 
plus  a  fifth,  the  icgion  unaffected  by  the  river.  The  form  of  each  boundary  follows  directly  from  Lemmas  V- 
2.1,  V-2.2,  V-2.3,  and  V-2.4.  ♦ 

LEMMA  V-3.1:A  road-edge  forms  a  boundary  between  homogeneous-  behavior  regions. 


PROOF  V-3.1:  Trivially  truc.4 


LEMMA  V-3  .2:Given  road  segment  with  goal  G,  one  vertex  V,  and  the  other  vertex’s  location  unspecified, 
and  cost-rate  rr,  with  cost-rate  in  the  background  ro.  If  the  characteristic  wedge  VAGB  as  defined  in  Chapter 
V  lies  "inside"  road-  vertex  V,  two  road-endlroad-travelling  boundaries  will  be  formed  as  rays  with  vertex  at 
V,  each  lying  so  that  its  angle  with  the  road  is  n/2  +  y. 

PROOF  V-3.2:Consider  the  road  segment  of  Figure  47a,  with  goal  G,  one  vertex  V,  and  the  other  vertex’s 
location  unspecified,  and  cost-rate  rr,  with  cost-rate  in  the  background  ro.  As  shown  in  [Ref.  2],  paths  will  enter 
leave  a  road  interior  only  at  the  critical  angle  y  =  sin'Vi/ro).  Thus  a  path  leaving  the  road  to  point  G  will  do 
so  at  point  A.  If  GA  docs  not  intersect  the  road  at  or  to  the  "left"  (in  the  figure)  of  V,  no  paths  will  travel  along 
the  road  from  the  direction  of  V.  Otherwise,  VAG  B  is  said  to  1  ie  "outside"  V,  and  paths  travel  along  the  road 
from  V.  Consider  points  Pi  and  P2  in  the  vicinity  of  P.  If  P  is  arbitrarily  close  to  V,  the  path  from  Pi  will  enter 
the  road  at  angle  y  en  route  to  A,  while  the  path  from  P2  will  enter  the  road  at  V.  Thus,  the  set  of  boundary 
points  P  lies  on  ray  VP  such  that  ZPVA  =  Jt/2  +  y.  The  same  reasoning  with  respect  to  point  Q  gives  that 
ray  VQ  also  is  a  boundary.  ♦ 

LEMMA  V-3  JtGivcn  road  segment  with  goal  G,  one  vertex  V,  and  the  other  vertex’s  location  unspecified, 
and  cost-rate  rr,with  cost-rate  in  the  background  ro.  If  the  characteristic  wedge  VAGB  lies  "inside"  road- 
vertex  V,  a  road-end! goal  boundary  will  exist  on  the  V  end  of  the  road  segment,  forming  a  segment  of  a  hy¬ 
perbola  with  V  and  G  as  foci  and  obeying  Equation  1 . 

PROOF  V-3J:Considcr  point  P  ir.  Figure  47b,  with  OPLi(P)  =  [V,  A,  G],  and  OPL2(P)  =  [GJ.  Since  the  two 
regions  through  which  the  optimal  paths  from  P  lie  have  points  as  roots,  Equation  1  applies,  and  the  bound¬ 
ary  is  a  hyperbola  segment  with  V  and  G  as  foci.  The  boundary  will  begin  at  the  point  at  which  the  hyperbola 
intersects  the  road-  cnd/road-travclling  boundary  of  Lemma  V-3,2.  ♦ 

LEMMA  V-3.4:Givcn  road  segment  with  goal  G,  vertices  Vi  and  V2,  and  cost-rate  rr,  with  cost-rate  in  the 
background  ro.  If  the  characteristic  wedge  VAGB  lies  "inside"  road-vertex  Vi,  a  near-side-road-travcll- 
ing'goal  wil  exist  on  the  near  side  of  the  river  which  forma  a  parabola  with  focus  G  and  directrix  as  specified 


ISS 


Figure  47 

Road  Segment  Boundaries 


in  Equation  2.  The  boundary  will  begin  at  the  point  of  intersection  of  the  parabola  with  the  road  segment, 
which  will  be  at  V2  if  VAGB  lies  "outside"  V2,  and  will  be  at  A  otherwise. 

PROOF  V-3.4:From  Figure  47c,  the  paths  from  P  go  to  the  road  and  travel  along  it,  or  go  to  the  goal.  Thus, 
the  boundary  is  between  regions  with  point  root  and  road  root,  so  Equation  2  applies.  Since  paths  leave  the 
road  at  W  in  Figure  37,  point  V2  will  correspond  to  point  W  if  the  wedge  is  "outside"  V2,  or  point  A  will  cor¬ 
respond  to  point  W  otherwise.  ♦ 

LEMMA  V-3.5:Given  road  segment  and  goal  G.  If  VAGB  is  "inside"  road  vertex  V,  a  road-travellinglroad- 
crossing  boundary  will  be  formed  on  the  far  side  of  the  river  which  is  a  ray  with  vertex  at  point  A  and  col- 
linear  with  GA  lying  away  from  G. 

PROOF:  V-3.5:If  VAGB  is  "inside"  V,  Figure  47d  will  apply.  Paths  from  points  Pi  just  to  the  "left"  of  P  in 
the  figure  will  cross  the  road  directly  to  G,  while  the  path  from  P  and  P2  enter  the  road  and  travel  along  it  to 
A,  where  they  exit  to  G.  ♦ 

LEMMA  V-3.6:Given  a  road  segment  with  vertex  V  and  goal  G,  with  7oad  cost-rate  rr  and  background  cost- 
rate  ro.  A  far-side-road-travellinglgoal  boundary  will  exist  if  Vis  outside  V.  The  boundary  will  be  a  parabola 
which  begins  at  V  and  lies  away  from  the  goal. 

PROOF  V-3.6:From  Figure  47f,  the  paths  from  P  go  to  the  road  and  travel  along  it,  or  go  to  the  goal.  Thus, 
the  boundary  is  between  regions  with  point  root  and  road  root,  so  Equation  2  applies.  Since  the  point  W  in 
Figure  37  is  the  point  at  which  paths  leave  the  road,  V  will  correspond  to  point  W.  ♦ 

LEMMA  V-3.7:If  VAGB  "straddles"  V,  a  road  shadow  boundary  will  exist  as  a  ray  from  V,  coliincar  with 
GA,  and  lying  away  from  G. 
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PROOF  V-3.7:From  Figure  47g,  a  path  from  Pi  will  cross  the  road,  while  a  path  from  P2  will  bypass  it  This 
will  occur  only  if  VAGB  "straddles"  V,  because  otherwise  paths  from  P2  will  enter  the  road  and  travel  along 
it  to  A.  ♦ 

THEOREM  V-3:Given  a  road  segment  V1V2  with  cost-rate  rr,  a  goal  G,  and  a  background  cost-rate  r&  if 
characteristic  wedge  VAGB  is  "inside"  Vi,  one  road-end/road-travelling,  two  road-end,  one  near-side-road¬ 
travelling/goal,  and  one  road-  travelling/road-crossing  boundaries  exist  on  the  Vi  end  of  the  road  segment; 
when  VAGB  "straddles"  Vi,  a  road  shadow  boundary  exists  on  the  Vi  end;  when  VAGB  is  "outside"  Vi,  one 
near-side-road-travelling/goal  and  one  far-side-road-travelling/goal  boundaries  exist  on  the  Vi  end;  and  the 
road  segment  is  always  a  boundary.  The  form  of  these  boundaries  is  as  described  in  Lemmas  V-3.1  through 
V-3.7. 

PROOF  V-3:Follows  directly  from  Lemmas  V-3.1  through  V-3.7.  ♦ 

LEMMA  V-4.1:Given  high-cost,  exterior-goal  HCA  with  two  visible  edges  Vi  V2and  V3  V4,  if  the  two  regions 
whose  paths  cross  the  two  edges  are  adjacent,  the  visible-edge  boundary  between  them  is  described  by  Equa¬ 
tion  Set  4. 

PROOF  V-4.1:Per  Figure  48a,  the  edges  V1V2  and  V3V4  are  roots  of  region  1  and  region  2  respectively.  Paths 
which  cross  them  go  directly  to  G,  and  so  the  description  of  Theorem  V-0.4  applies  to  this  situation,  and  Equa¬ 
tion  Set  4  describes  the  boundary.  ♦ 

LEMMA  V-4.2:Given  high-cost,  exterior-goal  HCA  with  a  visible  edge  Vi  V2  and  a  hidden  edge  V3V4,  if  the 
region  whose  paths  cross  edge  V1V2  and  the  region  whose  paths  go  to  and  travel  along  edge  V3V4  arc  ad¬ 
jacent,  the  visiblc-hiddcn-cdge  boundary  between  them  is  described  by  Equation  Set  5. 

PROOF  V-4.2:Pcr  Figure  48a,  the  edges  Vj  V2  and  V5V6  arc  roots  of  region  1  and  region  3  respectively.  Paths 
which  cross  edge  Vi  V2  obey  Snell’s  Law,  and  then  go  directly  to  G,  while  those  which  travel  along  edge  V5V6 
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leave  the  edge  at  point  V5  cn  route  to  the  goal  and  so  the  description  of  Theorem  V-0.5  applies  to  this  situa¬ 
tion,  and  Equation  Set  5  describes  the  boundary.  ♦ 

LEMMA  V-4.3:Given  high-cost,  exterior-goal  HCA  with  two  hidden  edges  V4V5  and  V6V7,  such  that 
OPL(P6)  =  [V5,  V4 1  OPL(P4)],  if  the  two  regions  whose  paths  enter  and  travel  along  the  two  edges  are  ad¬ 
jacent,  the  hidden-edge-merging-path  boundary  between  them  is  described  by  Equation  Set  3.  ♦ 

PROOF  V-4  J:PerFigure48c,  the  edges  V4V5  and  V6V7  are  roots  of  region  4  and  region  5  respectively.  Paths 
which  enter  edge  V4V5  at  the  critical  angle  travel  along  it  and  leave  at  V4  en  route  to  the  goal,  while  those 
which  travel  along  edge  V6V7  leave  the  edge  at  point  V6,  eventually  merging  with  paths  from  region  4.  So  the 
two  edges  are  linearly-  traversed  edges  and  arc  the  roots  of  regions  4  and  5,  so  the  description  of  Theorem  V- 
0.3  applies  to  this  situation,  and  the  boundary  is  a  line  segment  as  described  therein.  ♦ 

LEMMA  V-4.4:Givcn  high-cost,  exterior-goal  HCA  with  two  hidden  edges  V4V5  and  V6V7,  such  that 
OPLfPtf)  =  [V5,  V4 1  OPL(P4)],  if  the  two  regions  whose  paths  enter  and  travel  along  the  two  edges  are  ad¬ 
jacent,  the  hidden-edge-diverging-path  boundary  between  them  is  a  line  segment  described  by  Theorem  V- 
0.3. 

PROOF  V-4.4:Pcr  Figure  48c,  the  edges  V4V5  and  V7V8  arc  roots  of  region  4  and  region  6  respectively.  Paths 
which  enter  edge  V4V5  at  the  critical  angle  travel  along  it  and  leave  at  V4  en  route  to  the  goal,  while  those 
which  travel  along  edge  V7V8  leave  the  edge  at  point  Vs  (going  in  the  other  direction  around  the  exterior  of 
the  HCA).  So  the  two  edges  are  linearly-  traversed  edges  and  are  the  roots  of  regions  4  and  6,  so  the  bound¬ 
ary  between  them  is  a  line  segment  as  described  in  Theorem  V-0.3.4 

LEMMA  V-4.5:Givcn  a  high-cost  HCA  with  exterior  goal  G  and  vertices  Vi.  There  is  a  boundary  associated 
with  each  Vi  such  that  optimal  paths  in  one  region  cross  edge  Vi-iVj  and  optimal  paths  in  the  other  region 
cross  edge  VjVi+i,  except  in  the  case  that  shorcutting  occurs  along  the  entire  edge  VjVi+i  to  edge  Vm  Vj,  in 
which  case  no  boundary  occurs  for  vertex  V|. 
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PROOF  V-4.6:There  are  three  cases:  both  edges  arc  visible,  one  edge  is  visible  and  the  other  is  hidden,  or 
both  edges  are  hidden.  When  both  edges  are  visible,  by  definition  optimal  paths  from  neither  vertex  includes 
points  along  an  edge  of  the  HCA.  Consider  Figure  30,  and  points  near  V2  in  the  HCA  interior.  Since  the  inte¬ 
rior  has  higher  cost-rate  than  the  exterior,  there  is  no  incentive  for  paths  from  points  close  to  the  visible  edge 
to  move  further  away  from  it.  Rather,  such  paths  will  cross  the  edge  as  soon  as  possible  to  use  the  lower-rate 
exterior.  Thus  there  are  some  points  in  the  interior  close  to  Vi  whose  paths  cross  edge  Vi-t  Vi  and  some  whose 
paths  cross  edge  ViVi+t.  There  is,  therefore,  a  boundary  between  them  which  begins  at  Vi  and  lies  in  the  HCA 
interior. 

In  the  second  case,  by  the  same  reasoning  as  above,  some  paths  whose  start  points  are  close  to  Vi  will 
cross  visible  edge  Vi-i  Vi.  But  some  points  close  to  Vi  may  be  far  enough  from  edge  Vi-i  Vi  that  it  will  be  less 
costly  to  move  initially  away  from  the  goal  to  edge  ViVi+i  in  order  to  travel  at  the  less  expensive  exterior  rate. 
Clearly,  this  will  cause  a  boundary  which  begins  at  Vi.  If,  however,  edge  ViVi+i  forms  an  acute  enough  angle 
with  Vi-i  Vi  that  there  arc  no  points  near  Vi  for  which  it  will  be  less  costly  to  move  away  from  the  goal.  In  this 
situation,  shortculling  will  occur,  at  least  in  the  vicinity  of  Vi.  If  some  paths  travel  along  edge  ViVi+i,  the  point 
at  which  they  shortcut  into  the  interior  will  be  the  beginning  of  the  boundary  associated  with  Vi,  because  points 
just  inside  ViVi+i  and  toward  Vi+i  from  the  shortcutling  point  will  have  less  costly  paths  by  moving  away 
from  the  goal  to  the  lower-rate  edge,  while  points  just  inside  but  toward  Vi  from  the  shortcutting  point  will  go 
directly  across  the  HCA.  If  shortculling  occurs  all  along  edge  ViVi+t,  however,  there  will  be  no  boundary  as¬ 
sociated  with  Vj,  because  all  paths  have  the  same  behavior.  In  the  third  case,  by  the  same  reasoning  as  above, 
a  vertex  joining  two  hidden  edges  will  have  an  associated  boundary  unless  shortculting  occurs  all  along  the 
cdgc.4 

LEMMA  V-4.7:  The  edges  of  a  high-cost  HCA  with  exterior  goal  arc  homogeneous-behavior  boundaries. 

PROOF  V-4.7:Triviaily  lruc.4 
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LEMMA  V-4.8:Givcn  a  high-cost  HCA  with  exterior  goal  G,  each  vertex  V  of  a  hidden  edge  generates  a 
linear  shadow  boundary  which  is  the  ray  lying  on  the  line  defined  by  V  and  the  first  point  P  on  OPL (V),  start¬ 
ing  at  V  and  lying  in  the  opposite  direction  from  P. 

PROOF  V-4.8:  The  proof  is  the  same  as  for  Lemma  V-l  .2.  (See  Figures  23, 24,  and  25.)  ♦ 

LEMMA  V-4.9:Given  a  high-cost  HCA  with  exterior  goal  G  with  n  interior  boundary  trees.  There  exists  an 
opposite-edge  boundary  associated  with  each  tree  which  begins  at  the  point  at  which  an  interior  boundary  of 
the  tree  not  associated  with  a  vertex  (i.e.,  net  one  of  the  leaf  nedes  of  the  tree,  see  Figures  30, 3 1 ,  and  32)  in¬ 
tersects  an  edge  of  the  HCA.  There  is  also  an  opposite-edge  boundary  which  begins  at  each  point  at  which  two 
other  opposite-  edge,  or  a  shadow  and  an  opposite-edge  boundary  intersect.  An  opposite-edge  boundary  is 
described  by  Equation  1  if  the  interior  boundary  at  which  it  begins  separates  regions  of  two  linearly-traversed 
edges,  or  by  Equation  Set  6  if  the  interior  boundary  at  which  it  begins  separates  regions  whose  paths  cross  two 
edges  cn  route  to  the  goal.  If  it  begins  at  the  intersection  of  two  other  exterior  boundaries,  it  wili  be  described 
by  Equation  1  if  the  two  regions  which  the  intersecting  boundaries  do  not  have  in  common  have  point  roots, 
and  by  Equation  Set  6  (or  a  degenerate  version)  if  one  of  the  regions  which  the  intersecting  boundaries  do  "ot 
have  in  common  has  paths  which  cross  two  edges  en  route  to  the  goal. 

PROOF  V-4.9:  At  the  point  at  which  an  interior-boundary  tree  in.orsccts  a  hidden  edge  of  the  HCA  other  than 
a  vertex,  one  of  four  situations  must  exist.  An  optimal  path  from  the  point  of  intersection  may  go  across  the 
HCA  interior  and  a  second  optimal  path  from  the  same  point  travels  along  the  hidden  edge,  for  example,  in 
Figure  30  where  two  of  the  boundaries  labelled  "b"  intersect  edge  V4V5.  Secondly,  one  path  from  the  point  of 
intersccu'on  may  cross  a  visible  edge  and  a  second  path  cross  another  edge,  as  in  the  boundary  labelled  "a"  in 
Figure  30.  Third,  two  paths  may  go  from  the  point  of  intersection  in  opposite  directions  along  the  edge,  as  in 
the  boundary  labelled  ”d"  in  Figure  3 1 ,  where  one  path  goes  through  V4  and  one  path  goes  through  V3.  Fourth¬ 
ly,  there  may  be  only  one  optimal  path  from  the  point  of  intersection,  as  in  the  boundmy  in  Figure  31  tha!  in¬ 
tersects  edge  V2V3, 


195 


By  examining  Figures  30  and  3 1 ,  it  can  be  seen  that  when  there  are  two  optimal  paths  from  the  point  of 
intersection  of  the  interior  boundary,  there  are  points  in  the  HCA  exterior  which  also  go  in  two  directions, 
forming  a  boundary.  In  the  fourth  case  above,  where  there  is  only  one  optimal  path  from  the  point  of  intersec¬ 
tion,  it  can  be  seen  that  there  is  no  exterior  boundary.  But  the  interior  boundary  in  this  case  is  associated  with 
a  verte  x.  In  the  first  case,  the  exterior  boundary  separates  a  region  whose  points  go  to  the  vertex  of  the  hid¬ 
den  edge  through  which  goes  the  path  from  the  intersection  point,  from  the  region  whose  paths  cross  two  edges 
en  route  to  the  goal.  This  is  a  degenerate  case  of  Theorem  V-0.6,  where  one  path  crosses  two  edges  and  the 
other  path  goes  through  a  point  instead  of  crossing  two  edges,  so  Equation  Set  6  applies.  In  the  second  case, 
the  exterior  boundary'  separates  a  region  whose  paths  cross  two  edges  from  a  region  whose  paths  cross  two 
other  edges,  so  Equation  Set  6  applies.  In  the  third  case,  the  exterior  boundary  separates  two  regions  whose 
paths  go  through  points,  as  in  Theorem  V-0.1  and  Equation  1. 

When  any  two  exterior  boundaries  intersect,  it  must  be  that  a  third  opposite-edge  boundary  begins,  be¬ 
cause  past  the  point  of  intersection  there  must  be  a  discrimination  between  the  two  regions  which  the  first  two 
boundaries  did  not  have  in  common.  The  third  boundary  has  as  its  region  roots  either  two  points,  a  point  for 
one  root  and  two  edges  for  the  other,  or  two  different  edges  for  both  roots,  because  these  are  the  only  types  of 
roots  which  the  original  exterior  opposite-edge  boundaries  had.  These  roots  are  described  by  Equation  1  or 
Equation  Set  6,  where  a  degenerate  case  of  Equation  Set  6  is  the  case  that  one  of  the  pair  of  edges  is  replaced 
by  a  vertex.  Figures  30  and  3 1  show  examples  of  exterior  boundaries  intersecting.  ♦ 

LEMMA  V-4.10:Givcr.  high-cost  HCA  with  exterior  goal  G,  and  vertex  V  joining  a  visible  and  a  hidden  edge 
across  which  shortculling  occurs.  There  is  a  corner-cutting  boundary  which  begins  at  point  V  and  obeys  the 
degenerate  form  of  Equation  Set  6  where  paths  on  one  side  of  tlic  boundary  cross  two  edges,  while  paths  on 
the  other  side  go  through  a  vertex. 


PROOF  V-4.1G:(Sce  Figure  31 .)  Points  r  i  the  shadow  boundary  emanating  from  V2  in  Figure  31  (labelled 
"c")  go  through  Y;  to  the  goal.  Since  the  HCA  interior  has  a  higher  cost-rate  than  the  exterior,  there  arc  some 


points  just  below  the  shadow  boundary  which  will  travel  to  V2  rather  than  go  through  the  HCA.  But  points 
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further  below  the  shadow  boundary  will  have  further  to  go  to  vertex  V2  and  so  will  cross  the  HCA,  paying  the 
higher  cost-rate  to  do  so.  One  set  of  points  lies  in  a  region  with  V2  as  root,  while  the  other  set  of  points  lies  in 
a  region  with  edge  V2V3  as  root.  Paths  in  the  second  region  cross  two  edges  en  route  to  the  goal.  This  con¬ 
forms  to  the  degenerate  form  of  Equation  Set  6,  ♦ 

THEOREM  V-4:A  high-cost  HCA  with  exterior  goal  has  boundaries  according  to  Lemmas  V-4.1  through 
V-4.10. 


PROOF  Y-4:Follows  directiy  from  Lemmas  V-4.1  through  V-4.10.  ♦ 

LEMMA  V-5.I:Givcn  high-cost  HCA  with  interior  goal  G.  If  the  optimal  path  from  a  vertex  Vi  travels  ini¬ 
tially  along  an  edge  of  the  HCA,  there  is  a  hidden-edge  boundary  which  begins  at  Vi  and  is  a  line  segment 
conforming  to  Theorem  V-0.3. 

PROOF  V-5.1:(Scc  Figure  33.)  Assume  that  for  a  vertex  of  high-cost  interior-goal  HCA  Vi,  OPL(Vi)  =  [X, 
G ],  where  X  is  a  point  on  HCA  edge  VjVi-i ,  for  example  V3  in  Figure  33.  Then  there  will  be  some  points  close 
to  Vi  in  the  HCA  interior  which  will  exit  and  travel  along  edge  ViVi-i  to  X.  Similarly,  there  will  be  some  points 
close  to  Vi  on  edge  Vi+i  Vi  whose  paths  go  through  Vi,  and  so  there  will  be  points  close  to  Vi  in  the  HCA  in¬ 
terior  which  exit  the  HCA  and  travel  along  edge  Vi+i  Vj  to  Vi.  Thus  there  arc  two  regions  in  the  vicinity  of  Vi, 
and  the  boundary  between  them  separates  paths  which  enter  a  linearly-traversed  edge  and  travel  along  it  from 
those  which  enter  another  linearly-traversed  edge  and  travel  along  it.  This  is  the  situation  onheorem  V-0.3, 
so  the  boundary-  is  a  line  segment  as  described  therein.  ♦ 

LEMMA  V-5.2:Givcn  high-cost  HCA  with  interior  goal  G.  If  the  optimal  path  from  a  vertex  Vi  travels  ini¬ 
tially  along  an  edge  of  the  HCA,  there  is  a  liiddcn-cdgc/goal  boundary  which  is  a  parabola  as  specified  in 
Equation  2  which  separates  points  which  go  to  and  travel  along  edge  VjVi+i  from  points  which  go  to  and  travel 
along  edge  VjV|.|. 
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PROOF  V-5.2:(Sec  Figure  33,  boundaries  labelled  "b”.)  idy  the  same  reasoning  as  Lemma  V-5.1,  there  arc 
points  close  to  vertex  Vi  which  exit  the  region  and  travel  along  edge  Vi+iV;  to  Vi.  Consider  point  P  which  is 
moved  away  from  Vi  into  the  interior  along  the  hidden-edge  boundary  associated  with  Vi.  At  some  point,  paths 
from  P  which  go  to  edge  ViVi+i  will  cost  no  less  than  a  path  from  P  straight  to  the  goal  at  the  higher  cost  rate. 
At  this  point,  a  new  boundary  begins  separating  points  which  go  to  edge  ViVt+i  and  travel  along  it  to  Vi,  from 
points  which  go  to  G-  This  is  the  same  situation  as  described  in  Theorem  V-0.2,  with  Equation  2  describing 
the  parabolic  boundary.  ♦ 

LEMMA  V-5.3:Givcn  high-cost  HCA  with  interior  goal  G.  If  the  optimal  path  from  a  vertex  Vi  travels  ini¬ 
tially  along  edge  VjVj.j  of  the  HCA  and  cuts  into  the  HCA  at  some  point  along  edge  ViVi-t,  there  is  a  visible- 
edge /goal  boundary  which  is  a  parabola  as  specified  in  Equation  2  and  separates  points  which  travel  along  the 
visible  edge  VjVj.i  from  those  which  go  directly  to  the  goal. 

PROOF  V-5.3:By  the  same  reasoning  as  Lemma  V-5.2,  when  point  P  is  far  enough  from  Vi  that  paths  which 
go  to  edge  VjVi.j  cost  no  less  than  a  path  that  goes  directly  to  G  at  the  higher  cost  rate,  a  boundary  will  begin 
separating  points  which  go  to  the  linearly-traversed  edge  from  those  which  go  to  the  point  G.  This  is  the  same 
situation  as  described  in  Theorem  V-0.2,  with  parabola  as  described  in  Equation  2.  ♦ 

LEMMA  V-5.4:Givcn  high-cost  HCA  with  interior  goal  G,  and  two  adjacent  vertices  Vi  and  Vi+i  which  have 
optimal  paths  lying  on  HCA  edges,  neither  of  which  is  edge  ViVi+t.  Then  there  will  be  an  inierior-opposiie- 
edge  boundary’  which  is  a  line  segment  beginning  on  edge  ViVi+i  and  conforming  to  the  description  of  Theorem 
V-0.3. 


PROOF  V-5.4:If  the  optimal  path  from  Vi  lies  initially  on  edge  ViVj-i,  and  the  optimal  path  from  Vi+i  lies 
initially  on  edge  ViV^i,  as  must  be  by  assumption,  there  will  be  points  in  the  interior  of  the  HCA  as  described 
in  Theorem  V-0.3  which  have  paths  which  go  to  edge  V,V,ti  and  travel  along  it  to  Vi,  and  similarly  there  will 
be  points  ir  the  interior  which  have  paths  which  go  to  edge  V,Vj+i  and  travel  along  it  to  Vi+t.  Where  these 
two  regions  meet,  the  boundary’  will  separate  points  v.  hose  paths  go  to  one  linearly -traversed  edge  from  points 
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whose  paths  go  to  another  linearly-  traversed  edge,  the  situation  described  in  Theorem  V-0.3.  Therefore,  the 
boundary  will  be  a  line  segment  as  described  in  Theorem  V-0.3.  ♦ 

LEMMA  V-5.5:Each  edge  of  a  high-cost  HCA  with  interior  goal  will  be  a  hca-edge  boundary. 

PROOF  V-5.5:Trivially  true.  ♦ 

LEMMA  V-5.6:Given  high-cost  HCA  with  interior  goal  G.  If  the  optimal  path  from  a  vertex  Vi  travels  ini¬ 
tially  along  an  edge  of  the  HCA  with  OPL(Vi)  =  [X I  OPL(X)],  there  is  a  shadow  boundary  which  is  a  ray  with 
vertex  Vi  and  collincar  with  line  ViX,  which  lies  away  from  X. 

PROOF  V-5.6:Thc  proof  proceeds  as  in  Prool  V-l.2.4 

LEMMA  V-5.7:Given  a  high-cost  HCA  with  interior  goal  G,  and  opposite  edge  VjVi+i  as  defined  in  Lc;mma 
V-5.4.  Then  an  exterior  opposite-edge  boundary  exists  which  conforms  to  Equation  1. 

PROOF  V-5.7:At  the  point  at  which  the  interior-opposite-edge  boundary  intersects  edge  ViVi+i,  there  are 
two  optimal  paths  which  go  through  vertices  Vi  and  Vi+j.  Points  will  exist  in  the  exterior,  but  close  to  this  in¬ 
tersection;  point,  which  will  have  optimal  paths  which  go  through  these  vertices  as  well.  These  points  are  on  a 
boundary  which  separates  points  whose  paths  go  through  Vj  from  those  which  go  through  Vi+t,  two  regions 
with  point  roots.  Therefore,  Theorem  V-C.l  applies,  and  the  boundary  is  a  hyperbola  segment  which  conforms 
to  Equation  1.4 

LEMMA  V-5.8:  Given  high-cost  HCA  with  interior  goal  G,  and  vertex  Vi  which  has  optimal  path  which  goes 
directly  to  G.  There  will  be  a  visible-edge  boundary  in  the  HCA  exterior  beginning  at  Vi  which  conforms  to 
Equation  Set  4. 

PROOF  V-5.8:Considcr  points  close  to  V,  outside  the  HCA.  Since  the  best  path  from  Vi  is  straight  to  the  goal, 
clearly  paths  from  points  in  the  lower-cost  exterior  will  have  optimal  paths  which  go  directly  to  the  goal  via 
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a  Sncll’s-Law  path  across  one  of  the  edges  incident  upon  Vi.  The  boundary  which  separates  paths  which  cross 
one  edge  from  those  which  cross  the  other  edge  conform  to  the  situation  described  in  Theorem  V-0.4,  and  so 
the  boundary  will  conform  to  Equation  Set  4.  4 

LEMMA  V-5.9:Given  a  high-cost  HCA  with  interior  goal  G  and  vertex  V»  with  associated  hidden-edge/goal 
boundary  which  intersects  edge  ViVi+i.  Then  there  will  be  a  corner-cutting  boundary  which  begins  atthe  point 
of  intersection  and  continues  into  the  exterior  conforming  to  a  degenerate  form  of  Equation  Set  4,  where  one 
edge-crossing  degenerates  to  a  point  crossing. 

PROOF  V-5.9:(See  Figure  33,  boundaries  labelled  "h".)  At  the  point  of  intersection  of  the  hidden-edge/goal 
boundary  with  edge  ViVu-i,  there  are  two  optimal  paths;  one  goes  directly  to  the  goal,  and  the  other  goes 
through  Vj.  A  point  just  outside  the  HCA  in  the  vicinity  of  Lie  point  of  intersection  may  therefore  have  a  path 
which  goes  to  Vi,  or  which  crosses  edge  ViVi+i  en  route  to  the  goal.  The  boundary  separating  such  points  is 
therefore  a  boundary  between  a  region  which  has  a  point  as  root,  and  one  which  has  an  edge-crossing  as  root. 
This  is  a  degenerate  form  of  the  situation  of  Theorem  V-0.4,  so  Equation  Set  4  applies.  ♦ 

THEOREM  V-5:  Given  a  high-cost  HCA  with  interior  goal,  the  boundaries  associated  with  the  HCA  arc  as 
described  by  Lemmas  V-5.1  through  V-5.9. 

PROOF  V-5:  (Sec  Figure  33.)  Follows  directly  from  Lemmas  V-5.1  through  V-5.9.  ♦ 

LEMMA  V-6.1:Givcn  a  low-cost  HCA  with  interior  goal  point  G,  there  arc  no  boundaries  in  the  HCA  inte¬ 
rior. 

PROOF  V-6.1:  (See  Figure  34.)  Assume  that  there  is  a  point  P  with  optimal  path  OPL(P)  =  [R 1  OPL(R)],  i.c., 
that  the  path  docs  not  go  directly  to  the  goal.  R  must  lie  on  an  edge  or  vertex,  by  Theorem  1-2.  In  cither  case, 
the  path  must  be  longer  in  Euclidean  distance  than  the  line  segment  PG,  by  the  triangle  inequality.  Since  the 
interior  cost-rate  is  lower  than  the  exterior  cost-rate,  there  is  no  advantage  to  a  path  to  use  the  exterior  cost- 
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rate,  so  the  cost  of  PG  must  be  less  than  IPRI  +  l(RG)*l,  which  is  a  contradiction.  Therefore  all  interior  points 
have  the  path  list  [G  j.  By  the  definition  of  a  homogeneous-behavior  region,  the  entire  HCA  interior  is  a  single 
region,  so  there  are  no  interior  boundaries.  ♦ 

LEMMA  V-6.2:  Given  a  low-cost  HCA  with  interior  goal  G.  From  each  vertex  V  there  are  two  vertex/edge¬ 
crossing  boundaries  separating  points  whose  optimal  paths  go  through  V  and  then  to  G  from  those  which  cross 
an  edge  obeying  Snctl’s-Law  and  then  go  to  G.  Each  boundary  lies  on  the  the  path  from  G  through  V  which 
obeys  Snell’s  Law  for  crossing  one  of  the  edges  incident  upon  V. 

PROOF  V-6.2:(See  Figure  34.)  Consider  a  point  P  in  the  HCA  exterior  arbitrarily  close  to  the  exterior  leg  of 
a  Snell’s-Law  path  from  G  through  V  with  respect  to  edge  E.  The  optimal  path  from  P  goes  through  edge  E 
obeying  Snell’s  Law.  By  the  principle  of  optimality  (Theorem  l-l),  all  points  along  that  path  also  have  optimal 
paths  which  lie  on  the  same  path.  Titus,  the  boundary  is  a  ray  lying  at  the  angle  prescribed  by  Snell’s  Law.  $ 

THEOREM  V-6:Given  a  low-cost  HCA  with  interior  goal.  The  interior  has  no  boundaries,  and  the  exterior 
boundaries  arc  as  described  in  Lemma  V-6.1 . 

PROOF  V-6:Folfows  directly  from  Lemmas  V-6.1  and  V-6.2.4 

LEMMA  V-7.1:Given  a  low-cost  HCQ  with  exterior  goal,  each  edge  is  an  hca-edge  boundary. 

PROOF  V-7.1:Triviallv  true.  ♦ 

LEMMA  V-7.2:Givcn  low-cost  HCA  with  exterior  goal  G  and  vertex  V  such  that  the  optimal  path  from  V 
goes  initially  into  the  HCA  interior.  Then  a  vcrtcx/cdgc-crossing  boundary  exists  for  each  edge  incident  upon 
V  which  is  the  second  leg  of  a  path  from  G  through  V  which  obeys  Snell’s  Law  with  respect  to  the  edge,  and 
separates  paths  starting  in  the  exterior  which  go  through  V  from  paths  which  cross  the  edge.  If  the  optimal 
path  from  V  goes  initially  along  an  edge  of  the  HCA,  one  such  boundary  exists  with  respect  to  the  edge  inci¬ 
dent  upon  V  not  travelled  by  the  path  from  V. 
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PROOF  V-7.2:  (See  Figure  35.)  The  same  reasoning  as  in  Froof  V-6.2  applies  here.  ♦ 

LEMMA  V-7  J:Given  low-cost  HCQ  with  exterior  goal  G,  interior  cost-rate  n,  exterior  cost-rate  re,  and  ver¬ 
tex  V  such  that  the  optimal  path  from  V  goes  initially  along  an  edge  of  the  HCA  incident  upon  V.  Then  a  ver¬ 
tex!  edge-following  boundary  exists  which  is  a  ray  from  V  along  a  line  which  makes  the  angle  7C/2  +  0C  with 
the  edge,  where  0C= sin'1  (n/re). 

PROOF  V-7J:  (See  Figure  35.)  The  analysis  is  the  same  as  Proof  V-6.2  above.  ♦ 

LEMMA  V-7.4:Given  low-cost  HCA  with  exterior  goal  G,  and  vertex  V  with  optimal  path  which  goes  ini¬ 
tially  along  edge  of  the  HCA.  There  is  a  parabolic  edge-foilowingtgoal  boundary  which  begins  along  the 
edge,  conforms  to  Equation  2,  and  separates  paths  which  go  to  the  edge  and  follow  it,  from  paths  which  go 
directly  to  the  goal. 

PROOF  V-7.4:  (Sec  Figure  35.)  The  proof  is  the  same  as  for  the  ncar-side-road-  travelling/goal  boundary  for 
road  segments  in  Proof  V-3.4.  ♦ 

LEMMA  V-7.5:Given  low-cost  HCA  with  exterior  goal  G,  and  vertex  V  such  that  the  optimal  path  from  V 
lies  along  an  edge  of  the  HCA  incident  upon  V.  Then  there  is  a  hyperbolic  vertex/ goal  boundary  which  con¬ 
forms  to  Equation  1,  and  separates  paths  which  go  through  V  from  those  which  go  directly  to  G. 

PROOF  V-7.5:  (See  Figure  35.)  The  proof  is  the  same  as  for  road-end/goal  boundary  of  road  segments.  Proof 
V-3.3.4 
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LEMMA  V-7.6:Given  a  low-cost  HCA  with  exterior  goal  and  vettcx  Vi  such  that  the  optimal  path  from  Vi 
lies  in  the  HCA  interior,  and  vertex  Vj-i  adjacent  to  Vi  and  closer  to  G.  A  edge-crossinglgoal  will  exist  if  the 
vertex/goal  boundary  associated  Vi-i  intersects  the  both  vertex/edge-following  boundaries  emanating  from  Vi: 
l.  It  will  conform  to  a  degenerate  form  of  Equation  Set  6,  and  separate  paths  which  cross  edge  ViVs-i  and  then 
cross  a  visible  edge  en  route  to  the  goal,  from  paths  which  go  straight  to  the  goal, 

PROOF  V-7.6:  (See  Figure  35.)  At  the  point  at  which  the  hyperbolic  vertex/goal  boundary  intersects  the  ver¬ 
tex/edge-following  boundary  associated  with  edge  ViVi-i ,  the  two  regions  not  common  to  the  boundaries  are 
the  one  whose  paths  go  straight  to  the  goal,  and  the  one  whose  paths  cross  the  edge  en  route  to  a  second  edge 
crossing,  and  the  goal.  But  this  is  the  form  of  Theorem  V-0.6,  where  one  pair  of  edge-crossings  degenerates 
to  a  single  point-  crossing.  Thus  Equation  Set  6  applies.  ♦ 

LEMMA  V-7.7:Given  low-cost  HCA  with  exterior  goal  G,  and  vertex  V  with  optimal  path  which  goes  direct¬ 
ly  to  the  goal,  such  that  V  is  not  incident  to  any  other  homogeneous-behavior-regicn  boundaries.  There  is  a 
visible-  edge  boundary  in  the  HCA  interior  which  begins  at  V  and  continues  across  the  HCA  to  a  hidden  edge. 

PROOF  V-7.7:Consider  points  inside  the  HCA  near  V.  The  path  from  such  a  point  crosses  one  edge  incident 
upon  V  or  the  other  (Sec  Figure  35).  Therefore,  there  are  two  regions  inside  the  HCA.  and  the  ooundary 
separates  the  two.  Since  the  region  roots  are  both  edges  crossed  by  paths.  Theorem  V-0.4  applies,  so  the  bound¬ 
ary  conforms  to  Equation  Set  4.  ♦ 

LEMMA  V-7.8:Givcn  low-cost  HCA  with  exterior  goal  G,  and  vertex  V  with  optimal  path  which  goes  direct¬ 
ly  to  the  goal,  such  Ural  V  is  not  incident  to  any  other  homogcncous-bchavior-rcgion  boundaries,  and  giver, 
the  visible-  edge  boundary  in  the  HCA  interior  as  specified  in  Lemma  V-7.7.  There  is  an  opposite-edge  bound¬ 
ary  in  the  HCA  exterior  which  begins  at  the  point  of  intersection  of  the  visible-edge  boundary  with  the  hidden 
edge  and  conforms  to  Equation  Set  5. 
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PROOF  V-7  J:At  the  point  of  intersection  of  the  visible-edge  boundary  with  the  hidden  edge,  there  are  two 
optimal  paths,  which  cross  the  two  edges  incident  upon  V.  Points  in  the  HCA  exterior  near  this  point  of  inter¬ 
section  will  cross  into  the  HCA  interior,  crossing  on  one  side  or  the  other  of  the  point  of  intersection.  Points 
which  cross  on  one  side  will  traverse  the  HCA  interior  and  cross  one  of  the  edges  incident  upon  V,  while  points 
which  cross  on  the  other  side  will  cross  the  other  edge  incident  upon  V.  Therefore,  the  boundary  which  separates 
points  with  these  two  behaviors  conforms  to  Equation  Set  6.  ♦ 

THEOREM  V-7:Givcn  a  iow-cost  HCA  with  exterior  goal,  boundaries  are  generated  according  to  Lemmas 
V-7.1  through  V-7.8. 


PROOF  V-7:FolIows  directly  from  Lemmas  V-7.1  through  V-7.8.  ♦ 


APPENDIX  B  -  POINT-TO-POINT  WAVEFRONT  PROPAGATION 

ALGORITHM 


algorithm  wavefront-propagation  (Algorithm  B-l) 

input:  Start-Point,  Goal-Point 

[ 

Wavefront  :=  Start-Point; 

while  (Status = INPROGRESS)  [*  iteratively  expand  wavefront  until  */ 

expand-wavefront(Wavefront);  t*  status  is  DONE  or  NIL  */ 

if  (Status  =•  DONE) 

Optimal-Path  :=  Goal-Point  concatenated 
with  back-path(Goal-Point); 

else  I*  status  is  NIL,  so  no  feasible  solution  */ 

Optimal-Path  is  undefined; 

}  J*  end  of  wavefront-propagation  */ 

procedure  expand-wavefront 
input:  Wavefront 

I. 

if  (Wavefront  is  empty)  /*  Base  case  of  recursion.  If  empty  at  1st  call  */ 

Status  :=  NIL;  /*  to  expand-wavefront,  there  is  no  feasible  path  */ 

else 

{ 

Current-Cell  :=  cell  on  Wavefront  with  min  remaining  cost; 

expand-celI(Current-Ce!I); 

if  not  (Status  =  DONE) 

( 

Rest-of-Wavefront  :=  Wavefront  less  Current-Cell; 

expand-wavefront(Rest-of-WavefronQ;  f*  recutsive  call  to  expand-wavefront  */ 
if  not  (Status  =  DONE) 

{ 

Wavefront  :=  Cells-for-New-Wavefront  /*  Note:  Wavefront  is  recursively  emptied  */ 
appended  onto  front  of  Wavefront;  f*  out  level  by  level  and  new  Wavefront  */ 

Status  ;=  INPROGRESS;  /*  is  built  up  as  each  level  returns.  */ 

) 

) 

} 

)  !*  end  of  expand-wavefr  mt  */ 
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procedure  expand-cell 
input:  Current  Cell 

{  /*  initialize  flag  to  assume  that  Current-Cell  */ 

Finished-With-Cell  :=  TRUE;  /*  will  not  stay  on  Wavefront  */ 

Ceils-for-New-Wavefront  :=  empty  list; 
for  (Nev.'-Cell  :=  North-,  East-,  South-,  and  West-Neighbor) 
orthogonaI-expand(Current-Cell,New-Cell); 
for  (New-Cell  :=  Northeast-,  Southeast-,  Southwest-,  and  Northwest-Neighbor) 
diagonal-expand(Current-Cell, New-Cell); 

if  not  (Finished-With-Cell)  /*  keep  Current-Cell  on  Wavefront  */ 

Cells-for-New-Wavefront  :=  Current-Cell  appended 
onto  Cells-for-New-Wavefront; 


if  (Cells-for-New-Wavefront  contains  Goal-Point) 
Status DONE; 
else 

Status  :=  INPROGRESS; 

) 

procedure  orthogonal-expand 
input:  Current-Cell,  New-Cell 
{ 

if  ((Parent-Pointer-of-New-Cell  is  not  yet  set) 
or  (Parent-Pointer-of-New-Cell  =  Current-Cell) 
*/  or((InitiaI-Cost-of-New-Cell  - 1.414) 

<  Cost-of-New-CeU)) 

{ 

Parent-Pointer-of-New-Cell  :=  Current-Cell; 
Cost-of-Ncw-Cell  :=  Cost-of-New-Cell  - 1.414; 
if  (Cost-of-New-Cell  <  0) 

{ 

overJlow(Current-Cell,  New-Cell); 
Cells-for-New-Wavefront  :=  Overflow-List 
appended  onto  New-Cell; 

) 

else 

{ 

Cells-for-New-Wavefront  :=  empty  list; 
Finishcd-With-Cdl  :=  FALSE; 

) 

} 


I*  end  of  expand-cell  *1 


l*  if  this  is  first  cell  to  expand  into  New-  */ 
f*  Cell,  or  this  path  costs  less  to  expand  into  */ 

/*  New-Cell,  set  backpointer  and  explore  New-Cell. 


/*  Current-Cell  becomes  parent  of  New-Cell.  *1 
f*  decrement  cost  of  New-Cell  */ 

t*  if  New-Cell  has  been  fully  explored,  */ 

I*  then  New-Cell  and  possibly  an  overflow  */ 
i*  cell  are  added  to  new  Wavefront  */ 


f*  if  New-Cell  has  not  been  fully  explored,  */ 
f*  New-Cell  is  not  added  to  new  Wavefront  */ 
i*  but  reset  the  flag  to  note  that  V 
/*  Current-Cell  must  stay  on  Wavefront  */ 

/*  end  of  orthogonal-expand  */ 
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procedure  diagonal-expand 
input:  Current-Cell,  New-Cell 
{ 

if  ((Parent-Pointer-of-New-Cell  is  not  yet  set) 
or  (Parent-Pointer-of-New-Cell  =  Current-Cell) 
*/  or  ((Initial -Cost-of-New-Cell  - 1.0) 

<  Cost-of-New-Ccll)) 

{ 

Parent-Pointer-of-New-Cell  :=  Current-Cell; 
Cost-of-New-Cell  :r-.  Cost-of-New-Cell  - 1.0; 
if  (Cost-of-New-Cell  <  0) 
Cells-for-New-Wavefront  ;=  Cells-for-New- 
Wavefront  appended  onto  New-Cell; 
else 
{ 

Cells-for-New-Wavefront  :=  null  list; 
Finished-With-Cell  :=  FALSE; 

) 

} 


!*  if  this  is  first  cell  to  expand  into  New-  */ 

/’‘  Cell,  or  this  path  costs  less  to  expand  into  */ 

/*  New  -Cell,  set  backpointer  and  explore  New-Cell. 


/*  Current-Cell  becomes  parent  of  New-Cell.  */ 
/*  decrement  cost  of  New-Cell.  */ 
f*  if  New-Cell  is  fully  explored,  */ 

/*  add  it  to  new  Wavefront.  */ 


f*  if  New-Cell  is  not  fully  explored,*/ 

/*  do  not  add  it  to  new  Wavefront  */ 

f*  and  reset  flag  to  insure  that  Current-Cell  */ 

/*  gets  put  back  on  Wavefront  */ 

/*  end  of  diagonal-expand  */ 


procedure  overflow 
input:  Current-Cell,  New-Cell 
{ 

Overflow-Cell  :=  cell  cm  opposite  side  of  New-Cell  from  Current-Cell; 
if  ((Parent-Pointer  of  Overflow-Cell  is  not  yet  set) 
or  (Parent-Pointer  of  Overflow-Cell  =  New-Cell) 
or  ((Initial-Cost-of-New-Cell  - 1.0) 

<  Cost-of-New-Cell)) 

{ 

Parent-Pointer  of  Overflow-Cell  :=  New-Cell; 

Cost  of  Overflow-Cell  :=  Cost  of 
Overflow-Cell  +  (Cost  of  New-Cell); 
if  (Cost  of  Overflow-Cell  <  0) 

{ 

overflow(New-Cell,  Overflow-Cell); 

Overflow-List  :=  Overflow-List 
appended  onto  Overflow-Cell; 

} 

else 

Overflow-List  :=  empty  list; 

) 

else 

Overflow-List  :=  empty  list; 

) 


/*  Current-Cell  becomes  parent  of  New-Cell.  */ 
/*  decrement  Overflow-Cell  by  the  negative  */ 
/*  amount  left  over  from  New-Cell.  */ 

/*  if  necessary,  call  overflow  again.  */ 


l*  else  Overflow-Cell  is  not  */ 

I*  added  to  new  Wavefront.  */ 

/*  if  Overflow-Cell  already  has  */ 
/*  a  parent,  do  nothing.  */ 

/*  end  of  overflow  */ 
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APPENDIX  C  -  WAVEFRONT-PROPAGATION  OPM  CONSTRUCTION 

SOURCE  CODE 


a******************************************************************* 
******************************** * *********************************** 
*****  »opm"  creates  an  optimal  path  map  by  binding  the  boundaries 
*****  between  regions  of  similarly-behaved  optimal  paths  using  the 
*****  wavefront  propogation  algorithm.  The  basic  structure  of  the 
*****  wavefront  algoritlun  used  is  adapted  from  a  Prolog  program 
*****  by  MAJ  Bob  Richbourg,  June  87, 

*****  this  is  the  "pure"  version  which  tests  for  boundaries  by  checking 
*****  for  the  eguivalent  turn-points  in  the  optimal-path  list  of 
*****  neighboring  cells. 

***** 

*****  Current  as  of  27  Jun  89 
***** 

*****  Input:  files  "declar",  "initmap",  "utils",  "bdry",  t  "graphics". 
*****  output:  Graphical  output  to  the  host  Symbolics  screen. 


*** 


*****  function  "opm"  is  the  toprlevel  function  of  file  opm.lisp 
*****  Arguments:  none 
*****  Returned:  T. 

*****  Side  effects:  sets  ‘boundary*  array  with  the  pixels  which 
*****  represent  region  boundaries. 

*****  functions  Used?  initialize-map,  initialize-graphics, 

*****  expaud-wave front,  draw-and-show-windows, 

*****  draw-and-ahow-bdry-window,  kill-windows, 

*****  and  report-completion. 

(defun  opm  () 

(setf  *internal-timel*  (get-internal-run-time) ) 

(setf  ‘external-timel*  (get-universal-time) J 
(initialize) 

<pri  nc  "Inlt  Process  Time:  ") 

(prinl  (-  (setf  *internel-time2*  (get-internal-run-time))  *internal-timel*) ) 
(linefeed) 

(princ  "  Elapsed  Time:  ") 

(prinl  (-  (setf  *externa*-time2*  (get-universal-time) )  *external-timel * ) ) 
(linefeed) 

(do  ((Wavefront  (list  ‘goal*) 

(expand-wavefront  Wavefront)') ) 

((null  Wavefront))) 

;  (draw-and-show-wihdow) ) 

(cond  ((equal  nil  *incremental-bdry-check*)  (check-all-boundaries))) 

(princ  *  Expansion  Frocess  Time:  ”) 

(prinl  (-  (setf  *internal-Llmel*  (get-internal-run-time))  *internal-time2*) ) 
(linefeed) 

(princ  "  Elapsed  Time:.  ") 

(prinl  (-  (setf  ‘external-time! *  (get-universal-tlme) )  *external-timc2* ) ) 
(linefeed) 

(draw-and-show-bdry-window) 

(cond  ((null  *ineremental-bdry-check*)  (show-backpaths) ) ) 

(report-completion) ) 

********************  *_*  *************  *~*  AAA,.  A*  A***.,************************ 

!*"***  function  initialize  loads  files,  preprocesses  the  map,  and 
.«••••  'nitializes  the  graphics  screen. 

(defun  initialize  {) 

(load  "deciat") 

(load  "initmap") 

(load  "utils") 

(load  "bdry") 

(load  "graphics") 
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(initialize-map) 

(initial! re-graphics) 

(princ  "Beginning  Wavefront  Expansion") (linefeed) (linefeed) ) 


*****  Function  expand-wavef ront :  computes  the  nex'  vavefront  by  taking 
*****  the  first  pair  of  cell  coordina,  a  from  the  wave 

*****  and  processing  „t,  then  recursively  processing 

*****  the  rest  of  the  list  in  the  same  manner. 

*****  Argument:  Wave,  the  remainder  of  the  old  wavefront  left  to  process 
*****  Returned:  the  new  wavefront,  or  nil  if  Wave  becomes  empty 
*****  Side  Effects:  see  below 

*****  Functions  Used:  expand-cell  and  expand-wavefront 
(defun  expand-wavefront  (Wave) 

(cond  ((null  Wave)  nil) 

(t  (append  (expand-cell  (car  Wave)) 

(expand-wavefront  (cdr  Wave)))))) 


*****  function  expand-cell:  determines  which  of  the  eight  neighboring 
*****  cells  will  be  on  the  new  wavefront  and  whether  there  is  a 

*****  region  boundary  around  the  center  cell. 

*****  Argument:  Cell,  a  list  of  the  X,  Y  coords  of  the  cell  on 

*****  the  currant  wavefront  being  processed. 

*****  Returned:  A  list  of  cells  to  be  added  to  the  new  wavefront 
*****  Side  Effects:  none 

*****  Functions  Used:  orthog-expand,  diag-expand 


(defun  expand-cell  (Cell) 

(setq  *finished-with-cell-p*  't)  ;  initialize  flag  -  assume 

{  cell  will  not  stay  on  wf 

(cond  ((not  (null  »incrementa!-bdry-check*) )  (check-for-boundaries  Cell) ) ) 

(Jet*  ((X  (car  CelJ)) 

(Y  (cadr  Cell)) 

(Cells-to-add 
(nreverse 
(remove  nil 
(append 

(orthog-expand  (list  X  (1+  Y))  (list  X  Y) ) 

(orthog-expand  (list  (14  X)  Y)  (list  X  Y) ) 

(orthog-expand  (list  X  (1-  Y) )  (list  X  Y) ) 

(orthog-expand  (list  (J-  X)  Y)  (list  X  Y) ) 

(diag-expand  (list  (1-  X)  (14  Y) )  (list  X  Y) ) 

(diag-expand  (Hot  (11  X)  (14  Y) )  (list  X  Y) ) 

(diag-expsnd  (list  (14  X;  (1-  Y) )  'list  X  Y) ) 


(diag-expand  (list  (1-  X)  (1-  Y))  (list  X  Y) ) ) ) ) ) ) 

(cond 

((null  *f inished-vith-cel 1-p*)  ;  If  some  neighbors  are  not  fully 

(cons  (list  X  Y)  Cells-to-add))  ;  explored,  leave  center  cell  on  wf 
(t  Cells-to-add) ) ) ) 


(defun 

(let 


Function  diag-expand:  explores  a  cell-  which  is  in  a  diagonal 
direction  from  the  cell  being  expanded. 

Arguments:  same  as  orthog-expand 

Returned:  A  list  consisting  of  a  list  of  cells  to  be  added  to 
the  new  wavefront  and  a  flag  to  note  that  (1)  Center-cell 
has  fully  explored  its  neighbor,  or  (0)  it  lias  not. 

Side  Effects:  Sets  the  parent  coords  of  Mew-cell  if  they  are  nil 
diag-expand  (Mew-cell  Center-cell) 

((Xn  (car  Mew-celJ)) 

(Yn  (cadr  Mew-cell J) 

(Xc  (car  Center-cel  J ) ) 

(Yc  (cadr  Center-cell))) 
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'con  a 


W 

D 


0 } 

Yn  0} 


({null  (are!  ‘cell*  XV  Vn 
(setf  (are£  *cfcll*  X:i  Yn 
Center-cell) 

(set-opl  Xr»  Yn  Xc  Yc) 

(setf  ('are?  ‘cell*  X«v  Yn 

(-  (aref  ‘cell*  7U\  Yn  0»  1>) 
(cond  { (<»  (aref  ‘cell*  X;t  Yn  ,0}  0) 
(setq  "backpath-pixei-list* 
(append 

(cjet.-bac!;pr*-li  Xn  Yn) 
‘bachpet'i-pixel-liat*) ) 
(list  New-cell) ) 

(t  (setq  *£inished-with-cell" 
nil) ) ) ) 


((and  {•»  Xc  (car  (aref  acell*  Xn  Yn  1))) 
<-  Yc  (cade  (aref  ‘cell*  Xn  Yn  1))) 
(>  (aref  ‘cell*  Xn  Yn  0)  0)) 

(set £  (aref  ‘cell*  Xn  Yn  0) 

(-  (aref  ‘cell*  Xn  Yn  0)  1)) 
(cond  ((<*■  (arc £  *cell*  Xn  Yn  C)  0)  ; 

(setq  ‘bsckpath-pixel-list* 
(append  ; 

(get-backpatb  Xn  Yn)  ; 

*backpath-pixel-list‘) ) 
(list  New-cell) ) 

(t  (setq  ‘finished-with-cell-p* 
nil,).) ) ) 


It  New-cell  not  explored 
yet,  and  is  not  an  obstacle. 
Center-cell  becomes  its  parent 
Set  Opt-Path-List  for  (Xn, Yn) 

;  Decrement  cost 

I£  Newcell  is  £ully  explored 


add  its  parent  to  the 
display  list  of  parents 
and  odd  New-cell  to  wave, 
p*  ;  1 £  New-cell  is  not  fully 
;  explored,  don't  add  to  wf, 
;  and  r.ote  that  Center-cell 
;  must  stay  on  wavefront. 

;  If  Newcell' s  parent  is 
;  Center-cell  and  Newcell 
;  not  fully  explored, 

;  Decrement  cost. 


If  Newcell  is  fully  explored 

Add  parents  to  the 
hackpath  display 


(t  nil)))) 


5  Add  current  new  cell  to  wf 
;  If  New— cell  is  not  fully 
!  explored  don't  add  it  to 
;  wf,and  note  that  Center 
;  nuJt  stay  on  wavefront. 

If  Hewcell  w«s  already  explored,  don't  add  to  wave. 


»»** 
♦  *  *  * 


““  Function  orthog-expand:  explores  a  cell  which  is  in  an  orthogonal 
direction  from  the  cell  being  expanded. 

Arguments:  the  first  argument  is  a  list  of  the  X,Y 

coords  of  the  cell  being  explored;  the  second  is  a  list 
of  coordinates  of  the  cell  on  the  current  wavefront 
being  expanded  from. 

Returned:  A  list  of  two  elements:  the  first  is  a  list  of 

new  cells  to  be  added  to  the  new  wavefront  and  the  second 
is  a  flag  set  as  indicated  above  (in  diag-expand) 

Side  Effects:  Sets  the  parent  coords  of  Naw-cell  if  they  are  nil 
(defun  orthog-expand  (Mew-cell  Center-cell) 

(let  ( (Xn  (car  New-cell) ) 

(Yn  (cadr  New-cell) ) 

(Xc  (car  Center-cell)) 

(Yc  (cadr  Center-cell) ) ) 

(cond  ((null  (aref  ‘cell*  Xn  Yn  1))  ; 

(setf  (aref  ‘cell*  Xn  Yn  1)  ; 

Center-cell)  ; 

(set-opl  Xn  Yn  Xc  Yc)  ; 

(setf  (aref  ‘cell*  Xn  Yn  0) 

(-  (aref  ‘cell*  Xn  Yn  0)  1.414)) 

(cond  ( (<”  (aref  ‘cell*  Xn  Yn  0)  0) 

(setq  *backpath-pixel-list‘ 

(append 

(get-backpatli  Xn  Yn) 

*backpath-pixel-list*) ) 

(append  (overflow 

Mew-cell 
Center-cell) 

(list  Mew-cell))) 


If  Mew-cell  not  explored 
yet,  and  is  not  an  obstacle. 
Center-cell  becomes  Its  parent 
Set  Opt-Path-List  for  (Xn,Yn) 

;  Decrement  cost 

If  New-cell  is  fully  explored 


Add  itb  parent  to  the 
display  list 

Explore  next  cell  in  dir¬ 
ection  of  expansion  s  add 
any  overflow  cells. 

Add  current  new  cell  to  wf 


210 


;  to  right  of  overflow  cells. 

(t  (setq  *finished-with-cell-p*  ;  Else  if  Newcell  not 

nil)  nil)))  ;  fully  explored  don't  add 

;  it  to  wf, and  note  that 
;  Center-cell  stays  on  wf. 

((and  (»  Xc  (car  (aref  ‘cell”  Xn  Yn  1)))  ;  If  Newcell' s  parent  is 

(-  Yc  (cadr  (aref  ‘cell*  Xn  Yn  1)))  ;  Center-cell: 

(>  (aref  ‘cell*  Xn  Yn  0)  0)) 

(setf  (aref  ‘cell*  Xn  Yn  0)  ;  Decrement  cost. 

(-  (aref  ‘cell*  Xn  Yn  0)  1.414)) 

(ccnd  ( (<-  (aref  ‘cell*  Xn  Yn  0)  0)  ;  If  Newcell  is  fully  explored 

(setq  *backpath-pixel-list* 

(append  ;  Add  parents  to  the 

(get-backpath  Xn  Yn)  ;  backpath  display 

*backpath-pixel-list*) ) 

(append  (overflow  ;  Explore  next  cell  ir:  dl.r- 

New-cell  ;  ection  of  expansion  <  add 

Center-cell)  ;  any  overflow  cells. 

(list  New-cell)))  ;  Add  current  new  cell  to  wf 

;  to  right  of  overflow  cells, 
(t  (setq  *finished-with-cell-p*  :  It  New-cell  is  not  fully 

nil)  nil)))  ;  explored  don't  add  it  to 

;  wf, and  note  that  Center 
;  must  stay  on  wavefront. 

(t  nil))))  ;  If  Newcell  was  already  explored,  don't  add  it  to  wf. 


*****  runction  overflow:  determines  whether  expansion  should  continue 
*****  into  the  next  cell  in  the  (orthogonal)  direction  in  which 
*****  it  has  been  going,  and  expands  if  necessary. 

*****  Arguments:  the  first  is  a  list  of  the  X,Y  coords  of  the  cell 
*****  into  which  the  wave  will  overflow;  the  second  is  the  coords 

*****  of  the  cell  from  which  it  overflowed. 

*****  Note  that  Center-cell  in  this  function  is  the  variable 
*****  called  New-cell  in  orthog-expend,  and  Parent-cell  here  is 
*****  called  Center-cell  in  orthog-expand. 

*****  Aeturned:  A  list  of  cells  to  add  to  wavefront 
*****  Side  Effects:  cell  costs  are  decremented 
(defun  overflow  (Center-cell  Parent-cell) 

(let*  ((Xc  (car  Center-cell)) 

(Yc  (cadr  Center-cell)) 

(Xp  (car  Parent-cell)) 

(Yp  (cadr  Parent-cell)) 

(Xn  (t  Xc  (-  Xc  Xp) ) )  ;  Explore  the  next  cell  in  the  direction 

(Yn  (4  Yc  (-  Yc  Yp) ) )  ;  of  the  previous  expansion 

(New-cell  (list  Xn  Yn) ) 

(overflow-cost  ;  Check  if  overflow  is  at 

;  a  boundary; 

(cond  ((null  (aref  ‘cell*  Xn  Yn  0))  0)  ;  if  not, decrement  overflow 

;  cell  by  the  (negative) 

(t  (4  (aref  ‘cell*  Xc  Yc  0)  ;  amount  left  over  from 

(aref  *cell*  Xn  Yn  0))))))  ;  previous  cell. 

(cond  ((null  (aref  *cell*  Xn  Yn  1))  ;  If  overflow  cell  is  unexplored, 

(setf  (aref  ‘cell*  Xn  Yn  1)  ;  Set  overflow  cell  parent 

Center-cell)  ;  to  the  explored  cell. 

(set-opl  Xn  Yn  Xc  Yc)  ;  Set  Opt-Path-List  for  (Xn,Yn) 

,  f  *U»Kf  («r*f  *  Xn=  Yf!‘  OJ 

overflow-cost) 

(Cond  ( (<  overflow-cost  0) 

(setq  ‘hacKpath-pixel-liot* 

(arpend  ;  Add  parent  to  the 

{get-backpath  Xn  Yn)  ;  backpath  display. 

*hsckpnth-pl xcl-Il at  *) ) 
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(append  (overflow 

New-cell 
Center-cell) 
(liat  New-cell))) 

<t  nil))) 

<t  nil)))) 


;  If  more  overflow,  expand  again, 
and  add  Newcall  to  wave  liat. 


;  Elae  put  nothing  on  vavefror.t. 
Elae  put  nothing  on  wavefront . 
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;;;  Mode:  LISP;  Syntax:  Common -Li ap;  Package:  USER ■ -*- 


# 

;***“  "declar"  contains  the  declarations  of  global  variables  used 
;“*“  by  »opm".  It  is  loaded  by  function  "opm"  in  file  "opm. lisp". 
;  “  *  “  This  version  is  for  use  with  maps  in  the  form  of  a  rectangle 
;“*“  of  characters. 


;*““  Current  as  of  7  Jun  89 

;*““  side  Effects:  initialixation  of  *cell‘  and  ‘boundary*  arrays, 
>  “  *  “  and  other  global  variable*  as  listed  below. 


?*““  Global  Variables: 

(defvar  ‘version*) 

; (setf  ‘version*  "pure") (setf  ‘vertex-list*  nil)  (setf  ‘edge-list*  nil) 

(setf  ‘version*  "vertex-edge") 

; (setf  ‘version*  "diverging-path") (setf  ‘vertex-list*  nil) (setf  ‘edge-list*  nil) 

(defvar  ‘incremental-bdry-check*)  ;*““  set  to  't  if  check-boundaries  should 
(setq  *incremental-bdry-check‘  *t)  ;**••»  be  done  at  each  expand-cell,  nil  if  not. 

(defvar  *internal-timel‘) 

(defvar  *external-timel‘) 

(defvar  *internal-time2‘) 

(defvar  *external-time2‘) 

(defvar  *map-width*)  ;*““  Max  allowable  number  of  columns  in  the 

(setq  ‘map-width*  205)  ;  map  +.  2  for  bordering  columns  of  blanks 

(defvar  ‘map-length*)  ;*““  Max  allowable  number  of  lines  in  the 

(setq  ‘map-length*  155)  ;  map  (»153)  +  2  (“155)  for  the  bordering  lines  of  blanks 

(defvar  ‘magnification*)  ;*****  Magnification  of  the  screen. 

(setq  ‘magnification*  3)  ; 

(defvar  ‘river-cost*)  ;*““  Cost  to  cross  a  river 
(setq  ‘river-cost*  16) 

(defvar  *road-cost*)  ;  *****  Cost  to  use  a  road 
(setq  ‘road-cost*  0.1) 

(defvar  ‘mapline*)  ;*““  Array  to  hold  the  input  map:  each  element 

(setf  ‘mapline*  ;  is  a  string,  each  of  whose  characters 

(make-array  ;  represents  one  cell  of  the  map. 

(list  *map-length‘) ) ) 

(defvar  ‘terrain-pixel-list*)  ;  List  to  hold  coordinates 

(setq  ‘terrain-pixel-list*  nil)  ;  of  terrain  pixels. 

(defvar  ‘boundary-pixel-list*)  ;  List  to  hold  coordinates 

(setq  ‘boundary-pixcl-list*  nil)  ;  of  boundary  pixels. 

(defvar  ‘backpath-pixel-list*)  ;  List  to  hold  coordinates 

(setq  ‘backpath-pixel-list*  ni))  ;  of  backpath  pixels. 

(defvar  ‘finished-with-cell-p‘)  ;  Flag  to  record  if  cell  stays  on  wave. 

(defvar  ‘output-stream4)  ;  Can  be  used  to  define  output  stream 

(defvar  ‘goal*)  ;““*  coordinates  of  goal  point 

(defvar  *ce)l*)  ;*“**  3-dimen  array  whose  first  and  second  indices 

(setf  ‘cell*  ;  are  the  cell  coordinates  and:  whose  third  inoex 

(make-airay,  :  specifies- the- attribute: 

(list  ;  Attribute  0  is  cost  to  traverse  the  cell, 

‘map-width*  ;  decremented  as  wave  passes  over  cell, 

‘map-length*  ;  Attribute  1  is  list  of  parent's  coords 

4)))  ;  if  specified,  nil  if  not. 

;  Attribute  2  is  list  consisting  of  the 

;  character  symbol  of  the  cell,  followed  if 

;  if  applicable  by  an  edge  id  and  vertex  flag 
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(defvar  ‘boundary *) 

(setf  ‘boundary*  ; 

(make-array  ; 

(list  ; 

‘map-width*  ; 

‘map-length*  ; 

2) 

selement-type  'bit))  ; 
(defvar  ‘edge-list*) 

(defvar  ‘vertex-list*)  ; 


Attribute  3  is  coords  of  opt-path-liat  parent 
Bit-valued  array  to  mark  region  boundaries. 

The  (X, Y, 0)  element  specifies  whether  there  is 
a  boundary  to  immediate  right  of  cell  (X,Y). 

The  (X,Y,1)  element  specifies  whether  there  is 
a  boundary  immediately  below  cell  (X,Y). 

Altho  this  array  has  enough  info  to  specify 
boundaries  between  pixels,  pixel  (X,Y)  is 
plotted  us  the  boundary. 

These  lists  arc  for  the  heuristic  version,  and 
list  all  edge  cells  with  edge  id  C  vertex  cells. 
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...  Mode:  LISP;  Syntax:  Common-Lisp;  Package:  USER  r‘- 

.AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA_AAAAAAAAAAAA*AAA*AAAA.*A**AAAAAAAAA 
.  A  A  AAAAAAAAAAAAA  A  A  A  A  A  A  A  A  A  A  A  A  A  A  A  AAAAAAAA  A  A  A  A  A*  A  A  A  A  A  A  A  A  A  A  A  A  A  A  AAAAAAAAAA 

; a  a  a  a  a  "initmap"  contains  the  functions  used  by  "opm"  to  examine 
•  a  a  a  a  a  |-},e  map  symbols  and  encode  them  into  elements  of  the 
. a  a  a  a  a  *cen»  array.  It  is  loaded  by  function  "opm"  in  file  "opm". 
.aaaaa  xhis  version  is  for  use  with  maps  in  the  form  of  a  rectangle 
. a  a  a  a  a  0£  characters. 

•AAAAA 

.aaaaa  current  as  of  8  Jun  89 

.AAAAA 

; aaaaa  input:  file  "map",  an  array  of  cell  attributes 

.AAAAA 

.aaaaa  effects:  Loads  file  "map. lisp",  and  sets  the 

;•****  elements  of  the  "cell*  array  according  to  the 

;•****  associated  map  symbol.  Adjusts  *map-width*. 

.aaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaa 


aaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaaa 
***  Function  "initialize-map"  initializes  the  values  of  the 
array  "cell*  according  to  the  information  encoded 
in  graphic  form  in  the  file  "map". 

Arguments:  none 
Returned:  t  in  all  cases. 

Side  Effects:  Loads  the  Lisp  file  "map". 

Initializes  the  arrays  "cell*  and  "boundary* 
and  adjusts  the  variable  ‘map-width*. 

1  Functions  Used:  process-line,  process-char 
(defun  initialize-map  () 

(load  "map") (linefeed) (linefeed) 

(princ  "Initializing  Map") (linefeed) 

(cord  ( (equalp  ‘version*  "vertex-edge") 

(process-vertex-info  ‘vertex-list.*) 

(process-edge-info  ‘edge-list*) ) ) 

(setq  *map-width*  (+  2  (length  (aref  "mapline*  1)))) 

(do  ((I  0  (1+  I))) 

( (-  *map-width*  I)) 

(process-char  f\x  I  0)) 

(do(  (J  1  <1+  J))) 

((string-equal  "eof"  (aref  ‘mapline*  J) ) 

(do  ((I  0  (1+  I))) 

((-  ‘map-width*  I)) 

(process-char  l\x  I  J) ) )  ; 

(cond  ( (>«  J  ‘map-length* ) 

(princ  * IHARN1NG:  Map  too  long,  will  be  truncatedl ) (linefeed) 
(process-line  (aref  ‘mapline*  ‘map-length*)  1  *map-length*) ) 
(t 

(princ  "  Processing  Map  Row  ") (prinl  J) (linefeed) 
(process-line  (aref  "mepline*  J)  1  •!)))) 

(princ  "Finished  Initializing  I'ap")  (linefeed)  (linefeed)) 


Initialize  the  top 
"buffer  zone"  row 


Initialize  the  bottom 
"buffer  zone"  row 


.AAAAAAAAAAAAA A A4AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA. A  AAAAAAAAAAAAA 

.aaaaa  Function  "processTline,"  cycl»*  (firu  -ssch  chsrrstrr  sf  th? 

.aaaaa  argument  (a  string)  up  to  the  max  allowed  width  of  the  map. 
.aaaaa  it  processes  each  character  and  sends  a  warning 
;**•**  message  to  the  scteen  if  line  is  too  long. 

.aaaaa  Arguments:  Line,  a  string 
.aa.aa  Returned:  t  in  all  cases. 

.aaaaa  side  Effects:  Sets  s  1 -pixel  border  in  right  t  left  columns 
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;*****  represented  as  an  obstacle. 

.**«**  Functions  Used:  pcocess-chac 
(defun  process-line  (Line  X  Y) 

(cond  ( (-  0  (length  Line)}  ;  Normal  base  case 

(process-char  f\x  0  Y)  ;  Initialize  the  right  and  left 

(process-char  #\x  X  Y) )  ;  "buffer  zone"  columns 

(t  (process-char  (character  (subseq  Line  01))  X  Y) 

(setq  X  (1+  X)) 

(cond  ( (>“  X  "map-width")  ;  Abnormal  case  if  map  is  too  wide 

(process-char  J\r  0  Y)  ;  Initialize  the  right  and  left 

(process-chsr  t\x  (1-  X)  Y)  ;  "buffer  zone"  columns 
(princ  ' ( WARNING:  Map  too  wide,  will  be  truncated |) (linefeed) ) 
(t  (process-line  (subseq  Line  1)  X  Y)))))) 


*******  *********************  **************************************** 


*****  Function  "process-char"  decodes  each  character  of  the  map, 
*****  setting  the  cost  element  and  in  some  cases  the  parent 

*****  of  the  cell  indexed  by  X  and  Y,  the  cell's  coords, 

*****  and  the  parent  of  the  cell  on  the  Optimal-Path-Liat 
*****  Arguments:  Char,  a  character,  and  X  £  Y,  .integers. 

*****  Returned:  not  applicable. 

*****  Side  effects:  Sets  the  values  of  the  (X,Y,0)  element  of  the 
*****  *cell*  array  to  the  cost  as  specified  by  the  character; 
*****  in  some  cases  sets  the  values  of  the  (X,Y,1)  and  (X,Y,3) 

*****  elements  for  cells  having  no  parent. 

*****  Functions  Used:  no  user-defined  functions. 

(defun  process-char  (Char  X  Y 
iuux  X-  X+  Y-  Y+) 

(setq  X-  (-  X  (/  1  ‘magnification*))) 

(setq  XI  (*  X  (/  1  ‘magnification*) ) ) 

(setq  Y-  (-  Y  (/l  ‘mngni  f  icat.ion*) ) ) 

(setq  Y+  (+  Y  (/  1  ‘magnification*))) 

(cond  ((and  (>«  (char-int  Char)  49)  (<-  (char-int  Char)  57)) 

(setf  (aret  ‘cell*  X  Y  0)  (-  (char-int  Char)  48)) 

(setf  (aref  ‘cell*  X  Y  1)  nil) 

(setf  (aref  ‘cell*  X  Y  2)  (cons  Char  (aref  "cell*  X  Y  2))) 

(setf  (arer  ‘cell*  X  Y  3)  nil) 

(cond  ((-  1  (aref  ‘cell*  X  Y  0) )  nil) 

(t  (setq  *terrain-pixel-list* 

(append 

(mapear  'magnify-pixel 
(list 

(list  X  Y) ) ) 

♦terrain-pixel-list*) ) ) ) ) 

((equal  Char  l\  ) 

(setf  (aref  *cell*  X  Y  0)  nil) 

(setf  (aref  ‘cell*  X  Y  1)  (list  X  Y) ) 

(setf  (aref  ‘cell*  X  Y  2)  (cons  Char  (aref  ‘cell*  X  Y  2))) 

(serf  (aref  ‘cell*  X  Y  3)  (list  X  Y))) 

((equal  Cher  J\x) 

(setf  (aref  ‘cell*  X  Y  0)  nil) 

(setf  (aref  ‘cell*  X  Y  1)  (list  X  Y)) 

(setf  (aref  ‘cell*  X  Y  2)  (cons  Char  (aref.  ‘cell*  X  Y  2))) 

(setf  (aref  "cell*  X  Y  3)  (list  X  Y)) 

(setq  X-  (-  X  </  1  ‘magnification*))) 

(setq  XI  (■?  X  {/  l  'magnification*))) 

(setq  Y-  (—  Y  {/  1  ‘magnification*))) 

(setq  Y»  (+  Y  (/  1  ‘magnification*))} 

(setq  *terrain-pixel-iist* 

(append 

(mspear  'magnify-pixel 
(list  (list  X-  Y-) 

(list  X-  Y) 

(list  X-  Y+) 
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(list  X  Y-) 

(list  X  Y) 

(list  X  Y+) 

(list  X+  Y-) 

(list  Xf  Y) 

(list  X+  Y4) ) ) 

*terrain-pixel-list*) ) ) 

( (equal  Char  l\r) 

(set£  (aref  ‘cell*  X  Y  0)  *river-cost*) 

(setf  (aref  ‘cell*  X  Y  1)  nil) 

(set£  (aref  ‘cell*  X  Y  2)  (cons  Chat  (acef  ‘cell*  X  Y  2))) 

(set£  (acef  *cell»  X  Y  3)  nil) 

(setq  X+  (+  X  (/  1  ‘magnification*))) 

(setq  Y-  (-  Y  (/  1  ‘magnification*))) 

(setq  Y+  (+  Y  (/I  ‘magnification*))) 

(setq  ‘terrain-pixel-list* 

(append 

(mapcar  ' magnify-pixel 
(list  (list  X+  Y-) 

(list  X+  Y) 

(list  XI  Y4) ) ) 

‘terrain-pixel-list*) ) ) 

( (equal  Char  #\p) 

(sett  (nref  ‘cell*  X  Y  0)  *road-coat*) 

(setf  (aref  *celj*  X  Y  1)  nil) 

(setf  (aref  ‘cell*  X  Y  2)  (cons  Char  (aref  »cell*  X  Y  2))) 
(setf  (aref  ‘cell*  X  Y  3)  nil) 

(setq  ‘terrain-pixel-list* 

(cons  (list  X  Y)  *terrain-pixel-liat‘) ) ) 

((equal  Char  *\G) 

(setq  ‘goal*  (list  X  Y) ) 

(setf  (aref  ‘cell*  X  Y  0)  1) 

(setf  (aref  ‘cell*  X  Y  1)  (list  X  Y) ) 

(setf  (aref  *cell*  X  Y  2)  (cons  Char  (aref  *cell*  X  Y  2) ) ) 

(setf  (aref  *cell»  X  Y  3)  (list  X  Y) ) ) ) ) 


*****  Function  "process-vertex-info"  puts  the  character  v  into  each 
*****  ‘cell*  X  Y  2  as  a  list  (#\v) .  This  becomes  the  third  element  cf 
*****  this  list  after  "process-edge-info"  and  "process-char"  happen, 
(defun  process-vertex-info  (v-list) 

(setf  (aref  ‘cell*  (caar  v-list)  (cadar  v-list)  2) 

(list  l\v)) 

(cond  ((null  (cdr  v-list))) 

(t  (process-vertex-info  (cdr  v-list))))) 


**  *  *  * 
***** 
***** 

***** 
*  *  *  *  * 

(defun 

(let 


for  example,  13  is 
Y)  is  located. 


the 


Function  "process-edge-info"  puts  the  id  number  of  the  appropriate 
edge  into  *cell‘  X  Y  2  as  the  first  element  of  the  list  there. 
This  becomes  the  second  element  of  the  list  after  "process-char" 
is  executed. 

"e-list"  is  a  list  of  triples:  e.g., 

((X  Y  13)  (U  V  21)  ...  (Z  W  2)),  where 
id  number  of  the  edge  on  which  cell  (X 
process-edge-info  (e-list) 

;  jx  (first  (first;  e-llstH) 

(Y  (second  (first  e-list) ) ) 

(EdgelD  (third  (first  e-list)))) 

(cond  ((characterp 

(first  (aref  ‘cell*  X  Y  2))) 

(setf  (aref  ‘cell*  X  Y  2) 

(cons  (list  EdgelD) 


If  cell  is  a  vertex,  and 
no  other  edge  id  has  been 
set  for  this  cell,  set  1st 
element  of  list  to  EdgelD, 
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(aref  ‘cell*  X  Y  2)))) 

( (null  (first  (aref  ‘cell*  X  V  2) ) )  ;  Zf  cell  is  not  a  vtx,  and  ho 
(setf  (aref  ‘cell*  X  Y  2)  ;  other  edge  id  has  been  set,, 

(list  (list  Edge ID) ) ) )  ;  set  EdgelD 

( (listp  (first  (aref  ‘cell*  X  Y  2)))  ;  If  another  edge  id  has 

(setf  (aref  ‘cell*  X  Y  2)  ;  been  set  for  this  cell, 

(cons  (cons  EdgelD  ;  cons  EdgelD  onto  the 

(first  (aref  ‘cell*  X  Y  2)))  ;  1st  element  of  the 

(rest  (aref  ‘cell*  X  Y  2))))))  ;  previous  list. 

(cond  ( (null  (rest  e-list) ) ) 

(t  (process-edge-info  (rest  e-list)))))) 


Mode:  List;  Syntax:  Common-Lisp;  Package:  USER  -*- 


*  *  *  *  rile  "bdry"  contains  the  functions  which  detect  and  record 
****  boundaries  between  terrain  cells.  It  also  sets  and  checks 
****  equivalence  between  optimal-path  lists. 

*«*« 

****  Current  as  of  27  Jun  89 
**  *  « 

**************A**********#****«*A*******A4**AA*****A*A***A«**A***** 


A AAA**************************************************************** 

*****  Function  "check-nll-boundaries"  iterates  through  the  whole  map 
*****  to  find  boundaries.  It  is  used  when  boundary-checking  is  done 
*****  after  completion  of  wavefront  expansion. 

*****  Arguments:  None 
*****  Returned:  not  applicable 
(defun  check-all-boundaries  0 

(sett  "boundary-pixel-list*  nil) (linefeed) 

(cond 

((equal  "pure"  "version") 

(do  (<J  1  (1+  d))) 

((string-equal  "eof"  (aref  "mapline*  d) ) 

(linefeed) (princ  "Finished  Kith  Boundary  Detection") (linefeed) (linefeed) ) 
(princ  "Fure  Bdry  Detection  for  Row  ")  (prinl  J) (linefeed) 

(do  ((I  1  (1+  I))) 

{(>-  I  "map-width")) 

(cond  ((null  (aref  4;ell*  (1+  I)  *J  1)))  ?  Check  (I,d)  against 

( (pure-bdry-condition  ;  (I+1,J) 

I  J  (1+  I)  J) 

(add-to-bdry  I  J  (1+  I)  J),) ) 

(cond  ((null  (aref  "cell*  I  (1+  d)  1)))  ;  Check  (I,d)  against 

((pure-bdry-condition  ;  (I,d+1) 

I  J  I  (1+  J)) 

(add-to-bdry  I  J  I  (1+  J)))) 

(cond  ((null  (aref  "cell*  <1 F  I)  (1+  J)  1)))  ;  Check  (I,d)  against 
((pure-bdry-condition  ;  (I+l,d+l) 

I  J  (1+  I)  (1+  d)) 

(add-to-bdry  I  J  (1+  I)  (1+  d)))>))) 

( (equal  "diverging-path"  "version") 

(do  ((J  1  (1+  J))) 

((string-equal  "eof"  (aref  "mapline*  J) ) 

(linefeed) (princ  "Finished  With  Boundary  Detection") (linefeed) (linefeed) ) 
(princ  "Diverging-Path  Bdry  Detection  for  Row  "}  (prinl  J) (linefeed) 

(do  ((I  1  <14  I))) 

( (>»  I  "msp-width") ) 

(cond  ((null  (aref  "cell"  (1+  I)  <1  1)))  ;  Check  (I,d)  against 

((diverging-path-bdry-condition  ;  (I+l,d) 

I  J  (1+  I)  J) 

(add-to-bdry  I  d  (1+  I)  d) ) ) 

(cond  ((null  (aref  "cell"  1  (li  d)  1)1)  ;  Check  (I,d)  against 

((diverging-path-bdry-condition  ;  (I,d41) 

I  d  I  (H  d) ) 

(add-to-bdry  I  d  I  (1+  d) ) ) ) 

(cond  ((null  (aref  "cell*  (1+  I)  (14  d)  1)))  ;  Check  (I,d)  against 
((diverging-path-bdry-condition  ;  (Ill.jfLl) 

T  d  (is'  I)  (It  d)  J 

(add-to-bdry  I  d  (1+  I)  (1+  J) ) ) ) ) ) ) 

((equal  "vertex-edae"  "version") 

(do  ((d  1  (U  d))) 

( (string-eqnai  "eof"  (aref  "mapline*  d) ) 

(linefeed)  (princ  "finished  With  Boundary  Detection"HHnefced)  (linefeed)) 
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\princ  "Vertex-Edge  Bdry  Detection  for  Row  ")  (prinl  J) (linefeed) 

(do  ((1  1  (1+  1))) 

( (>»  I  "map-width*)) 

(cond  ((null  (aref  "cell*  (1+  1)  J  1)))  ;  Check  (1,0)  against 

((vertex-edge-bdry-condition  ;  (141,  J) 

I  J  (1+  I)  J  0  (list  1  J  (1+  1)  J)) 

(add-to-bdry  I  J  (It  I)  J) ) ) 

(cond  ((null  (aref  "cell*  I  <1+  0)  1)))  ;  Check  (I,J)  against 

((vertex-edge-bdry-condition  ;  (I,J41) 

10  1  (1+  J)  0  (list  I  J  I  (14  J) ) ) 

(add-to-bdry  I  J  I  (14  J) ) ) ) 

(cond  ((null  (aref  "cell*  (14  I)  (14  J)  1)))  ;  Check  <I,J)  against 
((vertex-edge-bdry-condition  ;  (141, J41) 

I  0  (14  1)  (14  0)  0  (list  I  J  (14  I)  (14  J))) 
(add-to-bdry  1  J  (14  I)  (14  J) )))))))) 


A******************************** ********  *************************** 

*****  Function  "check-for-boundaries"  checks  each  of  a  cell's  four  orthogonal 
*****  neighbors  for  the  existence  of  a  region  boundary.  It  ia  used 
*****  when  boundary-checking  is  done  incrementally  during  wave  expansion. 
*****  Arguments:  Center-cell, a  list  of  the  coords  of  the  cell  being 
*****  checked  and  aux  (local)  variables  to  hold  the  coords 

*****  Returned:  not  applicable 

*****  Side  Effects:  if  bdry  exists,  the  appropriate  pixels  are  added 
*****  to  ‘boundary-pixel-list*  and  "boundary-bit* (X, I)  is  set. 

*****  Functions  Used:  check-neighbor 
***** 


(defun  check-for-boundaries  (Center-cell 
(aux  X  Y) 

(setq  X  (car  Center-cell)) 

(setq  Y  (cadr  Center-cell) ) 

(cond 

({equal  "vertex-edge"  ‘version*) 

(cond  ((null  (aref  ‘cell*  X  (1-  Y)  1)))  ;  Check  (X,Y)  against  (X,Y-1) 

;  If  (X,Y-l)'s  parent  is  undefined 
;  boundary  cannot  be  checked  yet, 

((vertex-edge-bdry-condition  ;  Else  it  can  so  cal.)  bdry  condition. 

X  Y  X  (j-  Y)  0  (list  X  Y  X  (1-  Y))) 

(add-to-bdry  X  Y  X  (1-  Y) ) ) )  ;  If  bdry-cond  *•  T,  add  to  bdry-list. 

(cond  ((null  (aref  ‘cell*  (1-  X)  Y  1))) 

((vertex-edge-bdry-condition  ;  Check  (X, Y)  against  (X-1,Y) 

X  Y  (1-  X)  Y  0  (list  X  Y  (1-  X)  Y)) 

(add-to-bdry  X  Y  (1-  X)  Y))) 

(cond  ((null  (aref  ‘cell*  X  (14  Y)  1))) 

((vertex-edge-bdry-condition  ;  Check  (X,Y)  against  (X,Y41) 

X  Y  X  (14  V)  0  (list  X  Y  X  (14  Y) ) ) 

(add-to-bdry  X  Y  X  (14  Y) ) ) ) 

(cond  ((null  (aref  *cell*  (14  X)  Y  1))) 


((vertex-edge-bdry-condition  ;  Check  (X,Y)  against  (X41,Y) 
X  Y  (14  X)  Y  0  (list  X  Y  (14  X)  Y)  ) 


(add-to-bdry  X  Y  (14  X)  Y) ) ) ) 
{(equal  "pure"  ‘version*) 

(cond  ((null  (aref  ‘cell*  X  (1-  Y)  1 ) ) ) 


( (pure-bdry-condition 
X  Y  X  (3-  Y) } 

(add-to-bdry  X  Y  X  (1-  Y) ) ) ) 
(cond  ((null  (aref  ‘cell*  (1-  X)  Y  1))) 
( (pure-bdry-condition 
X  Y  (1-  X)  Y) 

(add-Cc.>-bd>,y  X  Y  (1-  X)  Y) ) ) 


;  Check  (X,Y)  agsinst  (X,Y-V- 
;  If  (X,Y-l)'s  parent  is  undefined 
;  boundary  cannot  be  checked  yet. 

Else  it  can  so  call  bdry  condition., 

;  If  bdry-cond  -  T,  add  to  bdry-list. 

Check  (X, Y)  against  (X-3,Y) 
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(cond  ((null  (aref  ‘cell*  X  (1+  Y)  1))) 

( (pure-bdry-condition  ;  Check  (X,  Y)  against  (X, Y41) 

X  Y  X  (1+  Y)) 

(add-to-bdry  X  Y  X  (1+  Y) ) ) ) 

(cond  ((null  (aref  ‘cell*  (1+  X)  Y  1))) 

( (pure-bdry-condition  ;  Check  (X, Y)  against  (X41,Y) 


X  Y  (1+  X)  Y) 

(add-to-bdry  X  Y  (1+  X)  Y)))) 
((equal  "diverging-path"  ‘version*) 

(cond  ((null  (aref  ‘cell*  X  (1-  Y)  1))) 


( (diverging-path-bdry-condition 
X  Y  X  (1-  Y)) 

(add-to-bdry  X  Y  X  (1-  Y) ) ) ) 
(cond  ((null  (aref  ‘cell*  (1-  X)  Y  1))) 
( (diverging-path-bdry-condition 
X  Y  (1-  X)  Y) 

(add-to-bdry  X  Y  (1-  X)  Y) ) ) 
(cond  ((null  (aref  ‘cell*  X  (1+  Y)  1))) 
( (diverging-path-bdry-condition 
X  Y  X  (1+  Y) ) 

(add-to-bdry  X  Y  X  <14  Y) ) ) ) 
(cond  ((null  <ar«£  ‘cell*  (14  X)  Y  1))) 
( (diverging-path-bdry-condition 
X  Y  (14  X)  Y) 

(add-to-bdry  X  Y  (14  X)  Y) ) ) ) ) ) 


;  Check  (X,Y)  against  (X,Y-1) 

;  If  (X, Y-l)'s  parent  is  undefined 
;  boundary  cannot  be  checked  yet, 

;  Else  it  can  ao  call  bdry  condition 

;  If  bdry-cond  ”  T,  add  to  bdry-list 

;  Check  (X,Y)  againct  (X-1,Y) 


;  Check  <X,Y)  against  (X,Y41) 


;  Check  (X, Y)  against  (X41,Y) 


*****  Function  "vertex-edge-bdry-condition"  checks  if  there  ia  a  boundary 
*****  between  two  cells  by  seeing  if  their  OPL' s  have  equivalent  "critical" 

*****  points,  where  a  critical  point  is  a  turn-cell  which  is  on  an  edge 
*****  or  i8  adjacent  to  a  terrain-feature  vertex. 

*****  Arguments:  Coords  of  2  cells  which  may  be  in  different  regions; 

*****  Flag  which  is  0  normally,  but  for  double-edged  cells  on  the 

*****  second  recursive  call  with  that  cell  is  a  list  of  the  left-over  edge-id, 

*****  and  for  edge-interior  pairs  is  1  or  (edge-id)  after  initial  call. 

*****  Returned:  nil  if  condition  does  not  hold,  and  T 
*****  if  condition  does  hold. 

*****  Side  Effects:  none 
***** 

(defun  vertex-edge-bdry-condition  (XI  Y1  X2  Y2  Flag  StartPoints) 

(let*  ( (Xsl  (first  StartPoints))  ;  bdry  cond  based  on  vertex 

( Ysl  (second  StartPoints))  ;  and  edge  turn  points. 

(Xs2  (third  StartFoints) ) 

(Ys2  (fourth  StartPoints)) 

(Parentl  (f irst-distinguished-opl-cell  XI  Y1‘  Xsl  Ysl)) 

(Parent2  (first-distinguished-opl-cell  X2  Y2  Xs2  Ys2) ) 

(Xpl  (first  Parentl)) 

(Ypl  (second  Parentl)) 

(Xp2  (first  Parent2)) 

(Yp2  (second  Parent2) )) 

(cond 

((not  (equal  ;  Case  A:  If  the  start-pts  themselves  have 

(first  (aref  *cell*  Xsl  Ysl  2))  ;  different  costs,  they  are  in  different 

.(first  (aref  ‘cell*  Xs2-  Ys2  2})))  f  regions.  Tnis  condition  tires  only 
't)  ;  on  c)ie  1st  call  to  v-e-b-c. 

((and  ;  Case  Bl:  If  SP1  is  edge  (4  SP2  is  inside  same 

(<  1  (length  (aref  ‘cell*  Xsl  Ysl  2)))  ;  rgn,  by  A  above)  and  Parent  of  2 

(equal  ;  is  on  the  same  edge  as  SP1,  and 

(second  (aref  ‘cell*  Xsl  Ysl  2))  ;  SP1  is  not  the  1st  of  a  pair  A 

(third  Farent2) )  ;  double-edge  cells,  do  not  put  a 
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(not  (equal 

(second  (aref  ‘cell*  Xsl  Ysl  2) ) 

(third  Parentl)))) 
nil) 

((and  ;  Case  B2:  If  SP2  is  edge 

(<  1  (length  (aref  ‘cell*  Xs2  Ys2  2))) 

(equal 

(aref  ‘cell*  Xs2  Ys2  2)) 


bdry  between  SP1  t  SP2. 

(This  case  makes  edge  cells  t 
inferior  cells  be  in  seme  rgn.) 


(second 

(third  Parentl) ) 

(not  (equal 

(second  (aref  ‘cell*  Xs2  Ys2  2)) 

(third  Parent2) ) ) ) 
nil) 

((and  (-  Xpl  Xp2)  ; 

(-  Ypl  Yp2) )  nil) 

((and  (“  3  (length  Parentl)) 

(-  3  (length  Parent2) ) )  ; 

(cond 

((set-equal  (third  Parentl) 

(third  Parent2)) 
(vertex-edge-bdry-condition 

Xpl  Ypl  Xp2  Yp2  0  StartPoints)) 
(  (and  ;  Case  t>2: 

(subsetp  (third  Parent2) 

(third  Parentl)) 

(not  (listp  Flag) ) ) 
(vertex-edge-bdry-condition 
XI  Y1  Xp2  Yp2 
(set-difference 
(third  Parentl) 

(third  Parent2)  ) 

StartPoints) ) 

( (and 

(subsetp  (third  Parentl) 

(third  Parent2}) 

(not  (listp  Flag))) 
(vertex-edge-bdry-condition 
Xpl  Ypl  X2  Y2 
(set-difference 
(third  Parent2) 

(third  Parentl) ) 

StartPoints) ) 

( (and 

(subsetp  (third  Parent2) 

(third  Parentl) ) 

(equal  Flag 

(third  Parent2))) 
(vertex-edge-bdry-condition 

Xpl  Ypl  Xp2  Yp2  0  StartPoints) ) 


(&  SP1  is  inside  same 
rgn,  by  A  above)  and  Parent  of  1 
is  on  the  same  edge  as  SP2,  and 
SP2  is  not  the  1st  of  a  pair  of 
double-edge  cells,  do  not  put  a 
bdry  between  SP1  C  SP2. 

(This  case  makes  edge  cells  t 
interior  cells  be  in  same  rgn.) 


Case  C:  If  Parentl  t  Parent2  are  the  same, 

;  Ptl  t  Pt2  are  in  same  rer’on. 

Case  D:  If  parents  are  both  edge  cells: 

;  Case  Dl:  If  edge-id  lists  are  the  same, 

;  chk  next  pair  of  cells  on  OPL  recursively 
;  (Normal  case) 


;  Else  if  Parentl  is  a  double-edge  cell  and 
;  one  of  ita  edge-ids  •  edge-id  of  Parent2, 
;  and  this  is  the  1st  time  Parentl  has  been 
;  checked  in  thia  set  of  calls  to  v-e-b-c 
;  recursively  check  OFL  with  Pointl  and 
;  Parent2,  with  flag  :»  (unmatched-edge-ld) 
;  of  Parentl.  (Only  applies  where  cell  1  is 
f  is  on  two  edges.) 

Case  P3; 

;  Else  if  Parent2  is  a  double-edge  cell  and 
;  one  of  its  edge-ids  »  edge-id  of  Parentl, 
;  and  this  is  the  1st  time  ParentZ  lias  been 
;  checked  in  this  set  of  calls  to 
;  v-e-bdry-cond,  recursively  check  on,  with 
;  Parentl  and  Point2,  with  flag 
;  (unmatched-edge-id)  of  Parent2. 


Case  D2,  Second  Pass; 

,*  Else  if  Parentl  is  a  double-edge  cell  and 
;  its  previously  unmatched  edge-id  -  id  of 
;  Farent2,  recursively  check  OPI,  from 
;  Parentl  <  Parent2,  with  flag  “  NIL. 


( (and 

(subsetp  (third  Parentl) 

(third  Parent2) ) 

(equal  Flag 

(third  Parentl))) 

(vertex-edge-bdry-condition 

Xpl  Ypl  Xp2  Yp2  0  StartFoints) ) 

(t  ' t) ) )  ;  Case  D4:  Otherwise  pts  are  in  different  rgns 

(t  't))))  ; 


Case  03,  Second  Pass: 

;  Else  if  Parent?,  is  a  double-edge  cell  and 
;  and  previously  unmatched  edge-id  -  id  of 
;  Parentl,  recursively  check  OPL  from 
;  Farentl  and  Farent2,  with  Flag  ••  NIL. 


Function  Mf irst-distinguished-opl-cell"  finds  the  first  cell  on 
the  opl  of  Ft  X,  Y  which  is  a  "distinguished"  point.  It  is  called 
by  function  "heuristic-bdry-condition" 
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;“*“  Arguments:  coords  of  the  cell  whose 
;*““  Returned:  a  list  of  the  coordinates 
followed  if  it  is  an  edge  cell  by 
;*““  Side  effects:  none 
(defun  first-distinguished-opl-cell  (X  Y  Xs 
taux  Dcell) 

(cond  ( (equalp 

(list  X  Y) 

(aref  ‘cell*  X  Y  3) )  (list  X  Y) ) 

< (setf  Dcell  (distinguished-cell 
(first  (aref  ‘cell*  X  Y  3)) 
t  (second  (aref  ‘cell*  X  Y  3)))) 

(cond 

( (-  3  (length  Dcell))  Dcell) 

( (not  (equal 

(first  (aref  ‘cell*  Xs  Ys  2)) 
(first  (aref  ‘cell* 

(first  Dcell) 

(second  Dcell) 

2)))) 


opl  is  being  checked 
of  ttie  distinguished  cell, 
the  edge  id  num. 

Ys 

;  If  opl-parent«point,  cell  is  obstacle 
;  or  goal,  so  return  the  point  itself. 

;  (base  case  2) 

;  If  opl-parent  is  distinguished,  rtn 
;  coords  of  parent  and  possibly  the 
;  edge  id  number,  (base  case  3) 

;  If  !'<cell  is  edge  cell,  rtn  Dcell. 

;  If  Dcell  is  vertex  and  this  path 
;  started  outside  the  terrain  feature 
;  of  which  Dcell  is  a  vtx,  rtn  Dcell. 


Dcell) 

(t  (first-distinguished-opl-cell 
(first  (aref  ‘cell*  X  Y  3) ) 
(second  (aref  ‘cell*  X  Y  3) ) 
Xs  Ys)))) 

(t  (first-distinguished-opl-cell 
(first  (aref  *cell*  X  Y  3) ) 
(second  (aref  ‘cell*  X  Y  3)) 

Xs  Ys)))) 


;  Else,  recurse  to  look 
;  at  next  cell  on  opl. 


;  Else,  recurse  to  look 
;  at  next  cell  on  opl. 


• « 
* 

•  » 


»  ♦  **  * 


Function  "distinguished-cell”  determines  whether  cell  is  an  edge 
or  adjacent  to  a  terrain-feature  vertex. 

Arguments:  coords  of  the  cell  being  checked  for  disting,  status 
Returned:  (X  Y  edge-id-list)  if  cell  is  on  an  edge 
(X  Y)  if  cell  is  adjacent  to  a  vertex 
nil  if  cell  is  not  distinguished 
““  Side  effects:  none 
•fun  distinguished-cell  (X  Y) 

(let  ((X-  (1-  X)) 

(U  X)) 

(1-  Y)) 

(1+  Y) ) ) 


(X+ 
<Y- 
(Y+ 
(cond 
( (and 


«  1  (length  (aref  ‘cell*  X  Y  2))) 
(equal 

(second  (aref  ‘cell*  X  Y  21) 
(second 

(aref  ‘cell* 

(first  (aref  ‘cell*  X  Y  1)  > 
(second  (aref  ‘cell*  X  Y  1)) 
2))))  nil) 

(length  (aref.  ‘cell*  X  Y  2))) 

X  Y* (second  (aref  ‘cell*  X  Y  2)))) 
(aref  ‘cell 


If  (X, Y)  is  edge  cell 
and  is  the  first  of  a 
pair  of  adjacent  cells 
of  the  same  edge  in  the 
same  backpath, 
return  nil . 


<K  1 
(list 
( (and  (”  3  (length 
(not  (equalp 


;  If  (X, Y)  is  a  single  edge  cell, 
;  return  coords  s  edge-id-list. 

X-  Y  2))) 

(first  (aref  ‘cell*  X  Y  2) ) 

(first  (aref  ‘cell*  X-  Y  2))))) 


(list  X-  Y) ) 
i  lapH.  j*  i-  -Menath 
(not  (equalp 

(list  X-  Yi;) 

( (and  («  3  (length 
(not  (equalp 


(first  (aref 
(first  (aref 

(aref  ‘cell* 
(first  (aref 


X-  Y+  2  }-)-}- 
‘cell*  X  Y  2)> 
‘cell*  X-  Y+  2))))) 


Else  if  (X, Y)  is 
adjacent  to  a  vertex 
and  is  outside  the 
•tsrrcin  -f estate  cf 
which  the  vertex  is 
a  part,  return  coords 
of  vertex. 


X  Y-  2)j) 
‘cell*  X  Y 


21) 
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(first  (aref  ‘cell*  X  Y-  2))))) 

(list  X  Y-)) 

((and  (-  3  (length  (aref  ‘cell*  X-  Y-  2))) 

(not  (equalp  (first  (aref  ‘cell*  X  Y  2) ) 

(first  (aref  *cell*  X-  Y-  2))))) 

(list  X-  Y-)) 

((and  (-  3  (length  (aref  ‘cell*  X  Y+  2) ) ) 

(not  (equalp  (first  (aref  *cell‘  X  Y  2) ) 

(first  (aref  ‘cell*  X  Y+  2))))) 

(list  X  Y4)) 

((and  (-  3  (length  (aref  ‘cell*  X+  Y-  2))) 

(not  (equalp  (first  (aref  ‘cell*  X  Y  2) ) 

(first  <*ref  ‘cell*  X+  Y-  2))))) 

(list  X+  Y-) ) 

((and  (-  3  (length  (aref  ‘cell*  X+  Y  2))) 

(not  (equalp  (first  (aref  ‘cell*  X  Y  2) ) 

(first  (aref  ‘cell*  X+  Y  2))))) 

(list  X+  Y) ) 

((and  (~  3  (length  (aref  ‘cell*  X+  Y+  2))) 

(not  (equalp  (first  (a/.ef  ‘cell*  X  Y  2) ) 

(first  (aref  ‘cell*  X+  Y+  2))))) 

(list  X+  Y4 ) ) 

(t  nil))))  ;  Else  (X,Y)  is  not  adjacent  to  a  vertex 

;  and  is  not  an  edge  cell 


.•»*****«****•*«*************«************************«**«*******«*** 
;***♦*  runction  "add-to-bdry"  sets  the  boundary  bit  to  1  and 
;***“  adds  boundary  pixels  to  the  front  of  the  boundary  list 

;**•**  unless  one  of  the  arguments  id  an  obstacle  cell. 

;““*  Argument:  coords  of  two  points  whose  boundary 
;*•***  is  to  be  added. 

;«***•  Returned:  always  returns  T 
;*****  side  effects:  Sets  'boundary*  bit  to  1  and 
;*•***  sets  *boundary-pixel~J ist*  to  the  previous 

;***“  list  with  the  new  pixels  appended  to  the  front. 


(defun  add-to-bdry  (XI  Y1  X2  Y2 
toux  Xa  Xb  Ya  Yb) 

(cond 

((or  (char-equal  l\x  (car  (aref  ‘cell*  XI  Y1  2))) 

(char-equal  l\x  (car  (aref  *cell*  X2  Y2  2))))'t) 
(t 

(setq  Xa  (4  XI  (/  (-  X2  XI)  ‘magnification*))) 

(setq  Ya  (+  Y1  (/  (-  Y2  Yl)  ‘magnification*))) 

(setq  Xb  (+  XI  (*  2  {/  (-  X2  XI)  ‘magnification*)))) 

(setq  Yb  (+  Yl  (*  2  (/  (-  Y2  Yl)  ‘magnification*)))) 

(setf  (bit  ‘boundary* 

(min  XI  X2)  ;  Set  the  be 

(min  Yl  Y2)  ;  flag  bit  e 

(cond  (("0  (-  Yl  Y2)J  0)  ;  or  ieftmos 

(t  1))) 


Set  the  boundary 
flag  bit  of  the  upper 
or  leftmost  cell. 


(setf  ‘boundary-pixel-list* 

(append 

(mapear  'magnify-pixel 
(cond 

( (»  XI  X2) 

(list  (list  (-  XI  (/  1  ‘magnification*))  Ya) 
(list  XI  Ya) 

(list  (4  XI  (/  1  ‘magnification*))  Ya) 

(list  (-  XI  (/  1  ‘magnification*))  Yb) 

(list  XI  Yb) 
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(list  (+  XI  (/  1  ‘magnification*))  Yb) ) ) 
(  (-  Yl  Y2) 

(list  (list  Xa  (-  Yl  {/  1  ‘magnification*))) 
(list  Xa  yi  ) 

(list  Xa  (+  Yl  (/  1  ‘magnification*))) 

(list  Xb  {-  Yl  {/  1  ‘magnification*))) 

(list  Xb  Yl  ) 

(list  Xb  (+  Yl  </  1  ‘magnification*) ) ) ) ) 
(t 

(list  (list  Xa  Ya) 

(list  Xa  Yb) 

(list  Xb  Ya) 

(list  Xb  Yb))))) 

*boundary-pixel-list*) )  ' t) ) J 


*****  function  "set-opl"  sets  the  coords  for  w  cell's  predecessor 
*****  in  the  optimal-path-list. 

*****  Arguments:  Xn  and  Yn  the  coords  of  the  new  cell  with  OPL  being 
*****  set  and  Xp  and  Yp  the  coords  of  (Xn,  Yn)'s  parent  on  backpath 
*““  Returned:  not  applicable 

*****  Side  Effects:  sets  ‘ceil* (Xn# Yn, 3)  with  n' s  predecessor  on  CPL 
*****  functions  Used:  on-line-between 
*  »  **  » 

(defun  set-opl  (Xn  Yn  Xp  Yp) 

(cond  ( (<  1  (length  (aref  ‘cell*  Xp  Yp  2) ) )  ;  If  P  is  an  edge  cell,  set 

(aetf  (aref  ‘cell*  Xn  Yn  3)  (list  Xp  Yp) ) )  ;  pred  of  H  to  P. 

((on-line-between  Xp  Yp  Xn  Yn  ;  If  P  is  between  N 

(first  (aref  ‘cell*  Xp  Yp  3))  ;  f,  pred  of  P  on  OPL, 

(second  (aref  ‘cell*  Xp  Yp  3)))  ;  set  pred  of  H  to 

(setf  (aref  ‘cell*  Xn  Yn  3)  (aref  ‘cell*  Xp  Yp  3)))  ;  pred  of  P. 

(t  (setf  (aref  ‘cell*  Xn  Yn  3)  (list  Xp  Yp) )  ) ) )  ;  Else  set  pred  of  II 

;  to  p  itself. 


““*  function  "pure-bdry-condition" 

*““  Arguments:  Coords  of  2  cells  which  may  be  in  different  regions 
*****  Returned:  nil  if  condition  does  not  hold,  and  T 
*****  if  condition  does  hold. 

*““  Side  Effects:  none 


(defun  pure-bdry-condition  (XI  'l\  X2  Y2) 

(let*  ((Xpl  (car  (aref  ‘cell*  XI  Yl  3))) 

(Ypl  (cadr  (aref  ‘cell*  XI  Yl  3)))  ; 

(Xp2  (car  (aref  ‘cell*  X2  Y2  3))) 

(Yp2  (cadr  (aref  ‘cell*  X2  Y2  3))) 
(Xppl  (car  (aref  ‘cell*  Xpl  Ypl  3))) 

( Yppl  (cadr  (aref  ‘cell*  Xpl  Ypl  3))) 
(Xpp2  (car  (aref  *cell*  Xp2  Yp2  3))) 
(Ypp2  (cadr  (aref  ‘cell*  Xp2  Yp2  3)))) 
(cond  ( (and  (-  Xpl  Xp2) 

(»  Ypl  Yp2))  nil) 

( (on-line-incl-between 

Xpl  Ypl  Xp2  Yp2  Xpp2  Ypp2)  I 
( (on-line-incl-between 

Xp2  Yp2  Xpl  Yd  Xppl  Yppl)  i 
( (on-line-incl-between 

Xpl  Ypl  X2  Y2  Xp2  Yp2)  nil) 

( (on-line-incl-between 

Xp2  Yp2  XI  Yl  Xpl  Ypl)  nil) 
(t  (add-tn-bdry  XI  Yl  X2  Y2))))) 


;  "Pure"  boundary  condition: 
If  OFLs  are  equivalent, 
return  nil,  else  return  T 


OFLs  are  equivalent  if 
first  cells  in  each 
OFL  are  equivalent,  ie, 
if  they  are  the  same, 
or  if  one  is  in  the 
first  leg  of  the 
OPL  of  the  other 


225 


.*«»**»•***************«************ A  ******************************** 

# 

;•****  Function  "diverging-path-bdry-condition" 

;*****  Arguments:  Coords  of  2  cells  which  may  be  in  different  regions 
;*****  Returned:  nil  if  condition  does  not  hold,  and  T 
;*♦***  if  condition  does  hold. 

;**•**  side  Effects:  none 

.«»*** 

0 


(defun  diverging-path-bdry-condition 
Caux  PC  PXc  PYc  PPc  PPXc  PFYc  PFPC 
(setq  PC  (aref  ‘cell*  Xc  Yc  1)) 
(setq  PN  (aref  ‘cell*  Xn  Yn  1)) 
(setq  PXc  (first  PC)) 

(setq  PYc  (second  PC)) 

(setf  PPC  (aref  ‘cell*  PXc  PYc  1)) 
(setq  PPXc  (first  PPC)) 

(setq  PFYc  (second  PPC)) 

(setf  PPPC  (aref  ‘cell*  PPXc  PPYc  : 
(setq  PPPXc  (first  PPPC)) 

(setq  PPFYc  (second  PPPC)) 

(setq  PXn  (first  PH)) 

(setq  PYn  (second  PN) ) 

(setf  PPN  (aref  ‘cell*  PXn  FYn  1)) 
(setq  PFXn  (first  PPM)) 

(setq  PPYn  (second  PPN) ) 

(setf  PPFH  (aref  ‘cell*  PPXn  PPYn 
(setq  PPPXn  (first  PFPH) ) 

(setq  PFFYn  (second  PPPH) ) 

(cond  ((and  (-  Xn  PXn)  (-  Yn  PYn)) 

( (bdry-condition-1 

PPPXc  PPPYc  PPPXn  PPPYn) 
(add-to-bdry  Xc  Yc  Xn  Yn) ) 

(  (bdry-condit ion-2 
Xc  Yc  PXn  PYn) 
(add-to-bdry  Xc  Yc  Xn  Yn) ) 

( (bdry-condition-2 
PXc  PYc  PXn  PYn) 
(add-to-bdry  Xc  Yc  Xn  Yn) ) 

( (bdry-condition-3 

PPXc  PPYc  PPXn  PPYn) 
(add-to-bdry  Xc  Yc  Xn  'n) ) 
(t  nil))) 


(Xc  Yc  Xn  Yn 

PPPXc  PPPYc  PN  PXn  PYn  PPn  PPXn  PPYn  PPPN  PPPXn  PPPYn 


rind  Center-cell's 
parent,  grandparent, 
great-grandparent 


;  rind  Neighbor-cell's 
;  parent,  grandparent,  and 
;  great-grandparent 


Keeps  obst  from  causing  bdry. 

;  If  greatgp's  are  separated 
;  by  more  than  two,  cells  are 
;  in  different  regions. 

;  If  cell  and  neighbor's 
;  parent  are  in  different 
;  regions,  so  are  cells. 

;  If  parents  are  in 
?  different  regions, 

;  so  are  cells. 

;  If  gp's  are  separated  by  an 
;  obst  or  river  cell,  there 
;  is  a  bdry  btwn  cells. 


*****  Function  "bdry-condition-1" 

*****  Arguments:  Coords  of  2  cells  which  may  be  in  different  regions 
*****  Returned:  nil  if  condition  does  not  hold,  and  T 
*****  if  condition  does  hold. 

*****  Side  Effects:  none 


(defun  bdry-condition-1  (XI  Y1  X2  Y2) 

(cond  ;  Boundary  condition  1: 

((or  (<  2  (abs  {-•  XI  X2) ) )  ;  if  cells  are  more  than  2  cells 

(<  2  (abs  (-  Y1  Y2) ) ) ) )  ;  opart,  return  ^true" 

(t  nil))) 


ft_ft***ftAftft*»ft*ftftft*ftft*ftftftft4 


;*****  Function  "bdry-condition-2" 

;***•*  Arguments:  Coords  of  2  cells  which  may  be  in  different  regions 
;*****  Returned:  nil  if  condition  does  not  hold,  and  T  if 
;**»**  condition  does  hold. 

;*****  Side  Effects:  none 

•  ft  ft  *  ft  * 

0 

(defun  bdry-condition-2  (XI  Y1  X2  Y2) 
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A  A  A  A  A 


***** 


*  A  *  A  A 
A  A  A  A  * 
A  A  A  A  A 
A  A  A  A  A 


A  A  A  A  A 


(defun 


(cond 
(  (and 

(“  1  (+  (aba  (~  XI  X2) ) 

(aba  (-  Yl  Y2) ) ) ) 

(not  (equal  (liat  XI  Yl) 

(aref  *cell*  X2  Y2  1))) 

(not  (equal  (list  X2  Y2) 

(aref  *cell*  XI  Yl  1))) 

(**  1  (hit  ‘boundary* 

(min  XI  X2) 

(min  Yl  Y2) 

(cond  ((-0  (-  Yl  Y2) )  0) 

(t  1>))>) 

;  then  return  "true" 
;  elae  return  "nil" 


,*  Boundary  condition  2: 

:  If  cella  are  adjacent, 

and  one  ia  not  the 
parent  of  the  other, 

and  bdry  bit  ia  aet, 


't) 

(t  nil?)) 


************* . 

function  bdry-condition-3"  checks  if  points  are  separated 
by  exactly  one  obstacle  or  river  cell.  If  so,  under  the 

Siiss:;ns;iS.r,ieh  cond-3  wUi  bc  caiied' they  - 

Arguments :  Coords  of  2  cells  which  may  be  in  different  redone 
Returned:  nil  if  condition  does  not  hold,  and  T 
if  condition  does  hold. 

Side  Effects:  none 

iH32  sr  ir-sss  zrsssx  ss/wr** 

will  thet-2,-0tcondiUonaVbeytru“  ",aP'  “nd  °"ly  ®cc«^"««y 


bdry-conditlonr-3  (XX  Yl  X2  Y2J 
(cond 

( (and  {-  2  (aba  (-  XX  y.2) ) ) 

(”  0  (-  Yl  Y2))) 

(cond 

((or  (char-equal  ?\>c  (aref 
(char-equal  »\r  (aref 

{ (and  {■*  0  (-  XI  X2)) 

(■*  2  (aba  (-  Yl  Y2)))) 

t  cond 

((or  (char-equal  f  \x  (aref 
(char-equal  l\r  (aref 

'■fell) 

it  nil}}) 


;  if  cells  are  2  apart  horizontally, 

;  and  0  apart  vertically,  and 
;  it  cell  between  them  is  an  obstacle 
'  oc  eivec,  their  children  are  in 
;  different  regions. 

‘cell*  (/  (+  xl  X2)  2)  Yl  2)) 

‘cell  *  {/  (+  xi  X2)  2?  Yl  2) ) ) 

;  Same  as  above  for  2  apart  vertically 
;  and  0  apart  horizontally. 

‘cell  *  XI  (/  (+  Yl  Y2)  2)  2)1 

‘cell*  XI  (/  (+  Yl  Y2)  2)  2))) 
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?;.  Mode:  MSP;  Syntax:  Commoo-Lisp?  Package:  USER 

•  *M***********M******M********>*M*  ^  #  *  A  * 

;*****  "utils. lisp"  contains  several  utility  functions  used  by  "opm" 
;♦****  f0unc)  in  file  "opm.licp"  and  r  dated  functions. 

•  *  A*  A  * 

,'*****  Current  as  of  7  Jun  89 

****** 

• 

.*********A*********A*****A***a************************************** 

p 

•  A*** A  ******************* *'  A***************************************** 
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Function  "on-line-incl-between"  determines  whether  the  first  point 
is  between  the  second  and  third,  inclusive. 

Arguments:  X  S  Y,  XI  6  Yl,  X2  5  Y2,  coords  of  three  points 
Returned:  non-nil  if  (X, Y)  is  strictly  btwn  (XI, Yl)  6  (X2,Y2), 
or  nil  otherwise. 

Side  Effects:  none 


(defun  on-line-incl-between 
(cond  ( (and 

((and  (-  X  X2)  <-  Y 

((and  (or  (<  XI  X  X2) 

(>  XI  X  X2) ) 

(or  (<  Yl  Y  Y2) 

(>  Yl  Y  Y2) ) 

(-  (/  (-  Y  Yl) 

(-  X  XI)) 

(/  (-  Y  Y2) 

(-  X  X2) ) ) ) ) 
((and  (=  X  XI  X2) 

(or  (<  Yl  Y  Y2) 

(>  Yl  Y  Y2) )  ) ) 
((and  (-  Y  Yl  Y2) 

(or  (<  XI  X  X2) 

(>  XI  X  X2) ) )  ) 

(t  nil))) 


If  (X, Y)  Is  strictly 
inside  the  rectangle 
formed  by  the  line 
endpoints,  check  by 
comparing  slopes  whether 
point  is  on  line. 


If  line  is  vertical,  check  by 
comparing  Y  coordinates. 

If  line  is  horizontal,  check  by 
comparing  X  coordinates. 

;  Else  return  NIL 


(X  Y  XI  Yl  X2  Y2) 

(-  X  XI)  (-  Y  Yl)))  ;  If  (X,  Y)  -  (XI,  Yl)  or 

Y2) ) )  ;  (X,  Y)  -  (X2,Y2),  return  T 


*****  Function  "on-line-between"  determines  whether  the  first  point 
*****  is  strictly  between  the  second  and  third. 

*****  Arguments:  X  S  Y,  XI  A  Yl,  X2  S  Y2,  coords  of  three  points 

*****  Returned:  non-nil  if  (X,Y)  is  strictly  btwn  (XI, Yl)  S  (X2,Y2), 


;*****  or  nil  otherwise. 

;***•*  Side  Effects:  none 

(defun  on-line-between  (X  Y  XI  Yl  X2 
(cond  ((and  (or  (<  XI  X  X2) 

(>  XI  X  Ji2) ) 

(or  (<  Yl  Y  Y2) 

(>  Yl  Y  Y2>) 

<«  (/  (-  Y  Yl) 

(-  X  XI) ) 

(/  (-  Y  Y2) 

(-  X  X2> ) )  ) ) 
('and  («  X  XI  X2) 

(or  (<  Yl  Y  Y2) 

(>  Yl  Y  Y21 1 )  } 

((and  (»  Y  Yl  Y2) 

(or  (<  XI  X  X2) 

(>  XI  X  X2) ) ) ) 

(t  nil))) 


Y2) 

;  If  (X, Y)  is  strictly 
;  inside  the  rectangle 
;  formed  by  the  line 
;  endpoints,  check  by 
;  comparing  slopes  whether 
;  point  is  on  line. 


;  If  line  is  vertical,  check  by 
;  comparing  Y  coordinates. 

;  If  line  is  horizontal,  check  by 
;  comparing  X  coordinates. 

;  Else  return  NIL 


;•****  Function  "mognify-pixel"  takes  n  pair  of  pixel  coordinates 
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;*****  and  returns  coordinates  which  are  k  times  magnified. 

;**“*  Argument:  Pixel,  a  list  of  two  numbers,  and  K,  the  magnification. 

;****•  Returned:  a  list  of  two  numbers,  each  number 

;**“*  being  K  times  the  original. 

;*****  Side  Effects:  none 
(defun  magnify-pixel  (Pixel) 

(list  (*  ‘magnification*  (first  Pixel)) 

(*  ‘magnification*  (second  Pixel)))) 


a******************************************************************* 
*****  Function  "magnify-pixel-list"  takes  a  list  of  pixel  coordinates 
*****  «nd  returns  a  list  which  is  k  times  magnified. 

*****  Argument:  Pixel-list,  a  list  of  lists  of  two  numbers  each, 
*****  an($  the  signification. 

*****  Returned:  a  list  of  lists  of  two  numbers,  each  number 
*****  being  K  times  the  original. 

*****  side  Effects:  none 
(defun  magnify-pixel-list  (Pixel-list) 

(cond  ((null  Pixel-list)  nil) 

(t  (cons  (list  (*  ‘magnification*  (first  (first  Pixel-list))) 

(*  ‘magnification*  (second  (first  Pixel-liat) ) ) ) 
(magnify-pixel-list  (rest  Pixel-list) ))))) 


*****  Function  get-backpath  finds  a  cell's  parent,  and  gives  the 
*****  pixels  from  the  cell  to  the  parent,  including  the  cell. 
*****  This  version  only  works  for  ‘magnif*  -  2  or  3 
*****  Argument::  X  C  X,  coords  of  cell  whose  backpath  is  required 
*****  Returned:  a  list  of  pixel  coords 
*****  side  Effects:  none 


(defun  get-backpath  (X  X 
taux  Parent-cell  Xm  Xm  Xp  Xp) 

(cond  ((null  (aref  ‘cell*  XXI))  nil) 

(t 

(setq  Parent-cell  (magnify-pixel  (aref  ‘cell*  X  X  1))) 

(setq  Xp  (first  Parent-cell) ) 

(setq  Xp  (second  Parent-cell) ) 

(setq  Xm  (*  ‘magnification*  X)) 

(setq  Xm  (‘  ‘magnification*  X)j 
(list  (list  Xm  Xm) 

(list  (+  Xm  (/  (-  Xp  Xm)  -magnification*) ) 

(+  Xm  (/  (-  Xp  Xm)  ‘magnification*))) 

(list  (+  Xm  (*  2  (/  (-•  Xp  Xm)  ‘magnification*))) 

(+  Xm  (*  2  (/  (•-  Xp  Xm)  ‘magnification*) )))))) ) 


******  Function  get-all-backpaths  finds  the  backpaths  from  every  cell 
;*«***  ot,  the  map  and  puts  them  in  pixel  form  into  *backpath-pixel-list* 
(defun  get-all-backpaths  () 

(setq  *backpath-pixel-list*  nil) 

(do  ({J  1  (1+  J))) 

((string-equal  "eof"  (aref  ‘mapline*  J) )  *backpath-pixel-list*) 

(do  ((1  1  (1+  I))) 

({”  (length  (aref  *mapline*  1))  I)) 

(setq  ‘backpath-pixel*1 ‘ 

(append 

(get-backpath  1  Of) 

*backpath-pixel-list-‘) ) ) ) ) 

•ft********************************  ***********  ***************  ******** 

;****»  Function  set-equal  checks  if  two  seta  are  the  same. 

******  Arguments:  Setl  and  Set2,  two  lists  treated  as  sets. 
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;**“*  Returned:  T  if  Setl  and  Set2  ate  the  same,  disregarding 
;*“**  repeated  elements,  MIL  otherwise. 

(defun  set-equal  {Setl  Set2) 

(cond  ( (and  (subsetp  Setl  Set2) 

(subsetp  Set2  Setl))) 

(t  nil))) 


.aaaaa  function  print-opl  is  a  debugging  function  to  print  the  OPL 
.-aaaaa  of  a  cell  to  the  screen. 

(defun  print-opl  (X  Y) 

(cond  ( (equal  ‘goal*  (list  X  Y) } ) 

(t  (print  (aref  ‘cell*  X  Y  3)) 

(prinl  (azef  ‘cell* 

(first  (aref  ‘cell*  X  Y  3) ) 

(second  (aref  ‘cell*  X  Y  3)) 

2)) 

(print-opl  (first  (aref  ‘cell*  X  Y  3)) 

(second  (aref  ‘cell*  X  Y  3))))}) 

.AaAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAaAAAAAAAAAAAAAAAAA 

. a  a  a  a  a  function  "linefeed"  is  a  mnemonic  for  terpri. 

;*““  Side  Effects:  causes  a  carriage  return  to  be  sent  to 
;**•**  the  output  stream. 

(defun  linefeed  () 

(terpri) ) 

(defun  linefeed2  <( 

(terpri  ‘output-stream*) ) 


. AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

•aaaaa  function  "report-completion"  sends  a  message  to  the  screen 
(defun  report-completion  () 

(linefeed) 

(princ  "Wavefront  expansion  complete")  (linefeed) 

(princ  "Type  (kill-windows)  to  remove  screen") (linefeed)  *t) 


.(AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAlAAAAAAAAAAAAAAAAAAAAAAAAAAA 

.aaaaa  runction  sort-condition  determines  the  order  between 
.aaaaa  t.wo  cells  on  the  wavefront. 

.aaaaa  Arguments:  two  sets  of.  coordinates 

.aaaaa  Returned:  TRUE  if  remaining  cost  of  first  cell  is  less  than 
.aaaaa  remaining  cost  of  second. 

.aaaaa  side  Effects:  none 
(defun  sort-condition  (Celll  Cell2) 

(let  ((XI  (first  Celll)) 

(Y1  (second  Celll)) 

(X2  (first  Cell2) ) 

(Y2  (second  Cell2))) 

(<  (aref  ‘cell*  XI  Y1  C) 

(aref  ‘cell*  X2  Y2  0)))) 
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...  -a_  Mode:  LISP;  Syntax:  Common-Lisp;  Package:  USER 

•AAAA<.AA4AAAAAAA*AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

•AAAaAAAAAAAAAAAAAAAAAAAAAAAAAAAhAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

;*****  rile  "graphics"  contains  the  functions  to  open  a  window  for 
;*****  displaying  the  terrain,  wavefront,  boundaries,  and  back-paths. 
;*****  It  £s  adapted  from  file  "graph. lisp"  written  by  Dr.  Se-Hung  Kwak 
.»»»»» 

;*****  Current  as  of  13  May  88 


•AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

.AAAAAAAAAAAAAAAAAAAAAAaAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

(defvar  "display-window*) 

(defvar  *draw-window*) 

(defvar  *draw-window-array*) 

(defvar  *draw-window-width*) 

(defvar  *draw-window-height*) 

(defvar  "draw-window-inside-width* ) 

(defvar  *draw-window-inside-height*) 

(defvar  *draw-window-position*) 

(defun  initialize-graphics  () 

(initialize-windows) 

(clear-window) 

(draw-goal) 

(draw-features  *ter rain-pixel-list*) 

(make-visible) ) 

(defun  draw-and-show-window  () 

(mapcar  'draw-pt  *boundary-pixel-list") 

(mapcar  'draw-pt  *backpath-pixel-list*) 

(make-visible) 

(setq  *backpath-pixel-list*  nil) ) 

(defun  draw-and-show-bdry-window  () 

(clear-window) 

(draw-goal) 

(draw-features  * terrain-pixel-list*) 

(mapcar  'draw-pt  *boundary-pixel-list*) 

(make-visible) ) 

(defun  draw-and-show-backpaths  () 

(clear-window) 

(draw-goal) 

(draw-features  (get-all-backpaths) ) 

(make- visible) 

't) 

(defun  show-boundary  () 

(mapcar  'draw-pt  *boundary-pixel-list*) 

(make-visible) ' t) 

(dcCun  show-terrain  () 

(drow-featur.es  *  ter  rain-pixel-list*) 

(make-visible)  't) 

(defun  show-goal  () 

(draw-goal ) 

V—*"*  v, 

(defun  stiow-backpaths  () 

(draw-features  (get-all-backpaths) ) 

(make-visible)  't) 

(<le fun  initialize-windows  0 
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(princ  "Initializing  Windows") (linefeed) (linefeed) 

(setf  *draw-window-width*  650) 

(setf  ‘draw-window-height*  500) 

(setf  ‘draw-window-position*  '(75  75}) 

(setf  ‘display-window* 

(tv: make-window  'tvrwindow 

:blinker-p  nil 

; position  ‘draw- window-posit ion* 
:width  *draw-window-width* 
:heig)it  ‘draw-window-height* 
:name  "display-window" 

:nave-bitr>  t 
:expose-p  t)) 

(setf  ‘draw-window* 

(tv :make- window  'tv:window 

:blinker-p  nil 

: position  ‘draw-window-position* 
:width  ‘draw-window-width* 

: height  ‘draw-window-height* 
:name  "draw-window" 
ssave-bits  t 
:ezpose-p  nil))' 

(setf  *draw-window-array* 

(send  *draw-window*  :bit-array)) 

(setf  *draw-window-inside-height* 

(send  *draw-window*  : inside-height) ) 

(setf  ‘draw-window-inside-width* 

(send  *<Jraw-window‘  :  inside-width)  )  ) 

(defun  cleat-window  () 

(tv: sheet-force-access  (‘draw-window*} 

(send  ‘draw-window*  :re£resh))) 


(defvn  draw-goal  () 

(tv: sheet-force-access  (‘draw-window*) 

(send  ‘draw-window*  :draw-string  "*" 

(-  (*  ‘magnification*  (first  *goal*>)  3) 

(+  (*  *magnification*  (second  *goal*))  5)))) 

(defun  make-visible  0 

(send  ‘display-window*  :bitblt 
tv:alu-seta 

*drav-window-i nside-wldth* 
*draw-window-insida-height* 

‘draw-window-array* 

2200)) 

(defun  kill-windows  () 

(send  ‘display-window*  skill) 

(send  ‘draw-window*  skill) 

(linefeed) (princ  "Windows  Killed") (linefeed) (linefeed) ) 

(dcfun  draw-features  (Pixel-list) 

(do  ( (P.est-of-list  Pixel-list  (rest  Rest-of-list) ) ) 
((null  P.est-of-list)) 

(draw-pt  (first  P.est-of-list)))) 


(defun  draw-pt  (point-coords) 

(tvishent-force-access  (*drnw-window* ) 

(send  *dtaw-window‘ 

:draw-point  (first  point-coords)  (second  point -coordn) ))) 
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APPENDIX  D  -  IIIGII-COST  EXTERIOR-GOAL  IICA 
INTERIOR-BOUNDARY  CONSTRUCTION  SOURCE  CODE 


/ 


rile  "bdrygen". 

Updated  12  Jan  89. 


This  program  generates  boundaries  for  JICA  interiors 

and  writes  them  to  two  files;  "bdry  out*  is  a  file  of  prolog 
facts  recording  the  boundary  and  terrain  information; 

"bdry_fig"  is  the  same  itifo  ready  for  plotting  by  the  "figur/s"  utility. 
Requires  "bgmapdata",  "bgutils",  "bgplotter",  and  "bdtyjoin" 
to  be  in  the  same  directory  when  started. 

Usage:  from  Unix,  type: 

prolog 
(bdrygen) . 
bo. 
halt . 


bg  :-  assert (write_f lag (write) ) ,  /*  or  (write_flao (no_write) )  */ 

initialize_bg, 
generate_bdrys, 
save  (bgstate) , 

tell (user) ,nl, write ('Boundary  generation  done  (First  Pass) ' ) ,nl, nl, 

reconsult (bdry join) , 

bdry_join. 

bg2  :-  qenerate_bdrys, 

tel  1 (user) ,  write (' Boundary  generation  done  (Second  Pass)'),nl, 
bdry_join. 


gencrate_bdrys  :- 

goal_point  (Xg,  Yg) , 

region_vertices ( (XI, Y1 ,  X2,  Y2 1 Rbisfcl ) ) , 
cons ( (XI, Yl, X2, Y2 I RListl J , (XI, Yl J ,  RList2) , 
initial_output ( (Xg, Yg) ,  Rbist2,  ) , 
classify_edges  (P.l.ist2,  (Xg,  Yg) ,  RMst3) , 
convert_vlist_to_elist  <1,  P.T.ist3,  Rl.ist4) , 
assert  (region^elist  IP.List4) ) , 
generate_boundariesO (Rtist4,  (Xg,  YgJ ) , 
order_initbdry_indicee,  ! . 

h 

*  Temporarily,  file  "bgmopdnta"  must  have  a  predicate  for  each 

*  vertex  with  its  optimal  path  list.  Eventually,  this  should  be 

*  replaced  by  a  call  to  a  path-finding  program  such  as  "sis"  or  "rrr" 


/‘Compare  1st  edge  w/  2d, 3d..,  recurse  to  comp  2d  edge  w/  3d, 4th. . , etc* 
generate JiotinrlariesO  ( (XI,  Yl,  VI  2,i:l2,X2,  Y2) ,  (Xq,  Yg )J  . 
generate_boundariesU ( 1X1, Yl, V12, H12, X2, Y2 (Rest ) ,  (Xg,  Yg) ) 

generate_boundsr  les  ( 1X1 ,  Yl,  VI 2,  III  2,  X2,  Y2 1  Rest  j ,  jxg,  l'g  J ) , 
gencral.e_bonndarie.iO (Rest,  (Xg,  Yg))  . 

/*  Slopping  condition:  only  one  edge  left  */ 
genera  te_boundories  ( !“  !• 

/ *  If  vertex  lial  from  fij.e  "bgniapdolft"  already  includes  the  */ 

/*  first  point  as  the  last,  it  will  appear  twice,  so  ignore  */ 

/*  the  second  0000151100.  f ! 

genet  at  e_boundaries  ( |  Xo,  Ya,  Xb,  Yb,  Xn,  '/a,_,  _,  Xb,  YbJ ,  !_,_))  !. 


/*  Type  1  */ 

generate_boundaries { (Xa, Ya, v, Nab, Xb, Yb, Xc, Yc, v, Ned, Xd, Yd  I  Rest] , (Xg, Yg) ) 

interior_cost(Ci), exterior  cost (Ce> ,  /*  2vis  (Typel)  bdty  */ 

plot  2vis  bdty  (Ci, Ce, Xa,  Ya,  Nab,  Xb,  Yb,  Xc,  Yc,  Hcd, Xd,  Yd) ,  /‘plot  Edgel,E2*/ 
genera te_boundaries ( (Xa,  Ya,  v. Nab, Xb, Yb| Rest) , lXg,Yg]) .  /* [El, E3 I  Rest ] */ 

/*  Type  2  */ 

generate_boundari.es  { (Xa,  Ya,  v,  Nab,  Xb,  Yb,  Xc,  Yc,  h  (r) ,  Ned,  Xd,  Yd  I  Rest ) ,  [Xg,  Yg) )  :  - 

interior_cost (Ci) ,  exterior  cost (Ce) ,  /*  lvis  (Type  2)  •/ 

plot_lvis_bdry (r, Ci,Ce, Xa, Ya,Nsb, Xb, Yb, Xc, Yc, Ncd,Xd, Yd) ,  /‘plot  El, E2*/ 
generate_boundaries ( (Xa, Ya, v, Nab, Xb, Yb 1  Rest ) , (Xg, Yg] ) .  /* (El, E3 1 Rest] »/ 

/*  Types  3  and  4  */ 

aenerate_boundaries ( (Xa, Ya, h (F) , Nab, Xb, Yb, Xc, Yc, h (G) , Ned, Xd, Yd ! Rest ] , (Xg, Yg J )  :  - 
Tnterior_cost (Ci) , exterior  cost (Ce) ,  /*  Ovis  (Type  3  or  4)  */ 

plot_Ovis_bdry (F, G, Ci, Ce, Xa, Ya, Nab, Xb, Yb, Xc, Yc, Ned, Xd, Yd) ,  /‘plot  El , 2‘/ 
generate_boundaries ( (Xa, Ya, b (F) , Nab, Xb, Yb| Rest J , (Xg, Yg) ) .  /* (El, E3 |RJ  */ 

initial! ze_bg 

consult (bgmapdata) , 
consult (boutils) , 
consult  (baplott.er) , 
tell (user) , nl, nl, nl, 

write (' Boundaries  being  computed: '), nl,  ! . 

initial_output ( (Xg, Yg] , Region, Region_elist) 
assert: (title ("  ) ) , 
title  (Title) , 

write_to_bdry_f ile (title, Title) , 
write_to_bdry_file (goal, (Xg, Yg) ) , 
write_to_bdry_£lle (region.  Region) , 

/*  write_to_bdry_£ile (region_elist, Region_elist) , 

wri'ce_to_f  ig_£ile  (title) , 

write_to_f ig_£ile (goal, IXg, Yg  J ) , 

wrlte_heading (region) , 

write  to  fig  file (region, Region) ,  */ 

! . 

/*  convert  list  of  vertices  (vertices  are  not  repeated)  to  a  list 

*  of  edges  (a  vertex  appears  once  for  each  edge) 

•  Also  number  the  edqes  sequentially,  and  assert  the  number  of  edges. 

•/ 

cotivert_vlist_to_elist  (N,  (X1,Y1,V1,X2,Y2),  (X1,Y1,V1,N,X2,Y2J) 
assert (number  of_edges (N) ) . 

convert  vlist_to_elist (H, (XI, Y1 ,o, X2, Y2 | RlistRest ) , 

“(XI , Y1 , o, o, X2, Y2 1 RevRLl stRest J )  : - 
convert  vlist  to_elist (H, (X2, Y2 ( RbistRest ) ,  RevRbistRest) ,  !. 

convert_vlist_to_elist  (!>7(X1,  Yl,  V1,X2,  Y2|  RLi stRest  J , 

(XI , yT, vl, N, X2, Y2 1 RevRListRest J )  : - 
Nplusl  is  II  4  1, 

convert_vlist_to_elist  (Nplusl,  (X2,  Y2(RI,istRest) ,  RevRListRest) ,  I . 

class!  fy_«ciges  (LI ,  (Xg,  Yg) ,  L6) 

edge_visibility_check  (1.1,  (Xg,  Yg) ,  L2) , 
r<->tate_edge_li  st  (1.1,  L3) , 
mark_edger (L3, L4) , 
insert  _opposite_pt  (L4, 1,5) , 
remark_edges (Lb,  L6)  ,  1 . 

/•  First  step  past  vis  edges,  leaving  their  markings  unchanged  */ 

remark  edges ( (XI,  Yl,  v,  X2, Y2 1 Rest ], (xl, Yl , v, X2, Y2 1 Rest2) ) 
rcmark_edges ( (X2, Y2|Rest J ,  (X2, Y2 1 Rest2J ) . 

/*  Now  step  past  h (b)  edges.  */ 

remark_cdges  ( (XI ,  Yl,  h  (b)  ,'x2,  Y2|P.eat) ,  (XI,  Yl,  h  (b) ,  X2,  Y2|Re3t2  J ) 
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remark_edges  ( |X2,  Y2 1  Rest  1 ,  |X2, Y2|Rest2|) . 

/*  At  each  li (ob)  edge,  change  'ob'  to  ' b'  */ 

remark  edges ( (XI, Yl j  h (ob) ,  X2,  Y2 1  Rest  J , (XI, Yl, h (b) , X2, Y2 |Rest2 J ) 
remark_edges ( (X2, Y2 1  Rest J , (X2, Y2 |Rest2) ) . 

/*  At  each  h(oa)  edge,  change  'oa'  to  'a'  */ 

remark  edges  < 1X1, Yl  j!  h (oa) , X2, Y2 1  Rest ) , (XI, XI, h (a) , X2, Y2 1 Rest2) ) 

“  remark_edges ( (X2, Y2 | Rest J , (X2, Y2 (Rest2) ) . 

/*  At  first  h(a)  edge,  stop.  */ 

remark_edges  ((XI,  Yl,  h(a)  ,X2,  Y2|Rest) ,  (XI,  Yl,  h  (a)  ,X2,  Y2|Rest]  > . 

/*  If  no  h(a)  edges,  stop.  V 
remark_edges ( (X, Y) , (X, YJ ) , 

insert_oppcsite_rt (L4, L5)  /*  On  first  pass,  assume  no  shortcutting  */ 

not (first_pass_done) ,  /*  occurs  and  set  up  opposite  point  */ 

insert_tentative_opp_pt (L4, L5) ,  /*  and  optimal  paths  accordingly.  */ 

assert_pseudo_ops (L5) ,  !. 

insert_opposite_pt (L4, L5)  /*  On  second  pass,  use  correct  opp  point  */ 

first_pass_done, 

insert_correct_opp_pt (L4, L5) ,  !. 

/*  On  FIRST  PASS,  insert  tentative  opposite  point  at  the  midpoint  of  */ 

/*  the  opposite  edges,  disregarding  any  possible  shortcutting.  */ 

/*  Change  marking  on  other  'o'  edges  accordingly.  */ 

/*  First  step  past  vis  edges,  leaving  their  markings  unchanged  */ 
insert_tentative_opp_pt ((XI,  Yl, v,X2, Y2 1  Rest J  ,  (XI,  Yl,  v,  X2,  Y2|Rest2) ) 
insert_tentative_opp_pt ( (X2, Y2| Rest] , [X2, Y2|Rest2) ) . 

/*  How  step  past  h(b)  edges.  '/ 

insert_tentative_opp_pt ( (XI, Yl, h (b) , X2, Y2 1  Rest  J , (XI, Yl, h (b) ,X2, Y2| Rest2) ) 
insert_tentative_opp_pt ( (X2, Y2 1  Rest) , (X2, Y2 |Rest2J) . 

/*  At  first  h(o)  edge,  branch  to  insert.. 2,  passing  opp  edge  info  along.  V 
lnsert_tentative_opp_pt  ( (XI ,  Yl ,  h  (o) ,  X2,  Y2  (Rest  J ,  Revised!,) 
optimal_path ( (XI, Yl IOF1J ,Cccw) , 

insert_tentetive_opp_pt2  ( (XI,  Yl,  h  (o)  ,X2,  Y2 1  Rest) ,  (XI,  Yl  J  ,Cccw,  Revised!,)  . 
/*  If  there  is  no  h(a)  edge,  go  to  insert.. 3,  then  stop  at  last  h(o>  edge  */ 

/*  opposite  point  in  previous  'o'  edges.  */ 
insert_tentati ve_opp_pt2  ( (XI,  Yl ,  li  (o) ,  X2,  Y2 ) , OB,  Cccw, R2)  : - 

insert_tentative_opp_pt3  (X2,  Y2,  [X2,Y2,  h(o)  |OEJ  ,Cccw,  R2)  . 

/*  At  each  h(o)  edge,  pass  opp  edge  info  along.  */ 
insert_tentative_opp_pt2  ( [XI,  Yl,  h  (o)  , X2, Y2|Rj,OE,Cccw,  R2) 

insert_tentative_opp_pt2 ( [X2,  Y2|R],  (X2,Y2,h(o)  |0E)  ,Cccw,  R2)  . 

/*  At  first  h(a)  edge.  Insert  lst-guess  opposite  pt  In  previous  'o'  edges.  */ 
inset t_tentative_opp_pt2  ( (XI ,  Yl ,  h  < j?  ,  X2,  Y2 1  P.J , OB,  Cccw,  OandAList )  s  - 
optimal_path ( (XI, Yl (OPcwJ  ,  Ccw) , 
reverse_edge_list.  (OE,OERev) , 
edge_length (OERev, Length) , 

0  is  (LengtMCcw-Cccw) /2,  /*  opp  pt  is  0  along  the  OEs  ccw  from  ptl  */ 

ins2rt_tent_opp_pt_along_edoes (OERev, D, OERevised) , 
con?  (OERevised,  (h(a),X2,Y2|R],  OandAList)  . 

/*  If  there  are  no  h(a)  edges,  insert  lst-guess  opp  pt  in  previous  'o'  edges.  */ 
insert_tentative_opp_pt3 (XI, Yl,OE, Cccw, OandAList)  !- 
optimal_path ( [XI, Yl |0Fcw) , Ccw) , 
reverse_edge_list (OE, OERev) , 
edge_length (OERev,  Length) , 

D  i a  (Length »Ccw-Cccw) /2,  /*  opp  pt  is  D  along  the  OEs  ccw  from  ptl  */ 

insert_tent_opp_pt_along_edges (OERev, D, OandAList) . 

insert  tent  opp  pt  along  edges  ( (XI,  Y 1,  li  (o)  ,X2,  Y2 |OE) , b,  (XI,  Yl, h  (ob)  ICERevJ ) 

~  distance  (Xl,Yl,X2,Y2,Dl),  02  is  0  -  01, 

D2  >  0, 

i user  t__tent_opp_pt_along_edges  ( [X2,  Y2 1 OE ) ,  02,  OEP.ev)  . 
insert  tent  Opp  pt  along  edges  (  (Xi,  YI,  iMo) ,  X2,  Y2  |OEJ ,  D, 

(Xl7vi ,  h  (ob) ,  Xopp,  Yopp,  h  (oa)  |0ERevJ  J  s- 
di  stance  (X1,Y1,X2,Y2,01),  02  is  D  -  £»i, 

D2  0, 
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DelX  is  X2  -  XI,  DelY  is  Y2  -  Yl, 

Xopp  is  XI  +  DelX*  ?D/D1) ,  Yopp  is  Y1  +  DelY* (D/Dl) , 
assert (opposite_point (Xopp, Yopp) ) , 
change_o_to_oa ( (X2,  Y2I0E] ,OERev) . 


change  o  to_oa ( (X, Y J , (X, Y] )  !. 

change~o~to  oa  (1X1,  Yl, h (a)  ,X2,  Y2|OE] ,  (XI, Yl, li (a)  ,X2, Y2|0EJ)  !. 

change_o  to“oa  ( (XI ,  Yl,  ft  (o) ,  X2, Y2 |OEj ,  (XI,  Yl,  li  (oa) ,  X2,  Y2 |OERev) ) 
“change  o  to  oa ( [X2, Y2|OE] , (X2, Y2 |0ERev]) ,  !. 


/*  At  each  vertex  along  tentative  opposite-edge  sequence,  assert  a  */ 

/*  pseudo-optimal-path  as  if  no  shortcutting  occurred  */ 

/*  First  step  past  visible  edges  */ 
assert_pseudo_ops ( (XI, Yl, v, X2, Y2 1  Rest ) ) 
assert_pseudo_ops ( [X2, Y2 (Rest) ) . 

/*  Now  step  past  'before'  edges  */ 
assert_pseudo_ops ( (XI, Yl, h (b) , X2, Y2 | Rest ) ) 
assert_pseudo_ops ( ( X2,  Y2 1 Rest  J ) . 

/*  At  first  'opposite'  edge  */ 
assert_pseudo_ops ( (XI, Yl, h (ob) ,X2, Y2 | Rest] ) 
optimal_path ( (XI, Yl |0P1 J ) , 
assert (pseudo_optimal_path ( (XI, Yl IOP1 ] ) ) , 
exterior_cost (Ce) , 

assert (pseudo_optimal_path ( (X2, Y2, c (Ce) ,X1, Yl |OPl] ) ) , 
assert_pseudo_ops2 ( (X2, Y2 (Rest] ) . 

/*  At  subsequent  'opposite'  edges  */ 
asser t_pseudo_ops2 ( (XI , Yl , h (ob) ,  X2, Y2 1 Rest ) )  :  - 
not (opposite_point (XI, Yl) ) , 
pseudo_optimal_path ( (XI, Yl | OP1 J ) , 
exterior_cost (Ce) , 

assert (pseudo_optimal_path( (X2, Y2,c(Ce) , XI, Yl jOPlJ ) ) , 
assert_pseudo_ops2 ( (X2,  Y2 |Rest] ) . 

/*  At  edge  with  'opposite  point'  */ 
asser t_pseudo_ops2 ( [XI, Yl , h (oa) ,  X2,  Y2 1 Rest J )  : - 
opposite_point (XI, Yl) , 
assert_pseudo_ops3 ( (X2,  Y2 1 Rest  J ) , 
pseudo_optimal_path ( (X2, Y2 10P2] ) , 
exterior_cost (Ce) , 

assert (pseudo_optioal_path ( [XI, Yl ,c(Ce) ,X2,Y2|OP2J ) ) . 

/*  If  there  are  no  'a'  edges,  assert  clockwise  OP  at  vertex  and  stop.  */ 
assert_pseudo_ops3  ( (Xl.-Yl  J ) 

optimal_path ( (XI, Yl I0P1J ) , 

assert  (pseudo_opti»nal_path  ( [XI,  Yl  |0P1  J ) )  . 

/*  Search  to  end  of  'o'  edges,  asserting  clockwise  OP  at  each  cw  vertex  */ 
assert_pseudo_ops3 ( (XI, Yl, h (oa) , X2, Y2|Rest] ) 
asser t_pseudo_ops3 ( (X2,  Y2|Rest] ) , 
pseudo_optimal_path ( (X2,  Y2 1 0P2 J ) , 
exterior_cost (Ce) , 

assert (pseudo_optimal_path ( (XI, Yl,  c (Ce)  ,X2,  Y2 (0P2J ) ) . 

/•  At  first  'after'  edge  assert  a  cw  ps-op  and  stop.  */ 
assert_pseudo  ops3?(Xl,  Yl,h(a)  ,X2,  Y2|Rest)) 
optimal_path ( (XI, Yl |0P1 J ) , 
assert  (pseudo_optimal_path ((X1,Y1|0P1))) . 

/*  On  SECOND  PASS,  insert  correct  opposite  point  into  the  */ 

/*  the  opposite  edges,  disregarding  any  possible  shortcutting.  */ 

/*  Chong—  .-irking  on  * O*  euges  accordingly.  : i 

/*  rirst  step  past  vis  edges,  leaving  their  markings  unchanged  */ 
inset t_correct_opp_pt ((XI, Yl, v, X2, Y2| Rest J , (XI, Yl, v, X2, Y2 I Rest2] ) 
inoert_correct_opp_pt  ((X2,Y2(P.est],  (X2,  Y2 1 P.est2) )  . 

/•  No w  step  post  h(b)  edges.  */ 

insert_correct_opp_pt ( (XI, Yl, h (b) ,X2, Y2 iRestJ , [XI, Yl, h (b) ,X2, Y2I Rest2) )  :- 
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insert_correct_opp_pt ( (X2, Y2 1  Rest), [X2,Y2|Rest2] ) . 

/*  At  each  h(o)  edge,  see  if  opp  pt  is  on  this  edge.  */ 

/*  If  so,  revise  rest  of  h(o)  edges  and  insert  opp  pt.  */ 

insert  correct  opp  pt([Xl,Yl,h(o) ,X2,Y2|Rest], 

[XI,  Yl7h  (ob) , Xopp,  Yopp,  h  (oa) ,  X2,  Y2|Rest2] ) 
opposite_point (Xopp, Yopp) , 
on_line (Xopp,  Yopp,  XI,  Y1,X2,Y2) , 
change_o_to_oa ([X2, Y2 1  Rest) , 1X2,  Y2 1 Rest2] ) ,  1. 

/*  If  not,  mark  edge  h(ob)  and  look  at  rest  of  h(o)  edges.  */ 
insert_correct_opp_pt ( [XI, Yl, h (o) , X2, Y2|Rest J , [XI, Yl, h (ob) ,X2, Y2 |Rest2) )  :- 
insert_correct_opp_pt ( [X2, Y2 1  Rest} , (X2, Y2 |Rest2] ) . 

/*  Step  thru  edge-list,  rotating  it  until  all  visible  edges  are  on  its  */ 

/*  front,  and  all  hidden  edges  are  on  its  end.  */ 

/*  Upon  finding  a  hidden  edge  before  any  vis  edge,  put  it  on  the  end,  */ 

/*  and  start  again  looking  for  vis  or  hidden  edges.  */ 

rotate  edge_list ( (XI, Yl, h,X2, Y2 1  Rest] , RevisedList)  :- 
"  cons ( [X2, Y2 1 Rest) , [h,X2,  Y2J ,  L2) , 
rotate_edge_list (L2, RevisedList) ,  ! . 

/*  Upon  finding  first  vis  edge,  step  thru  the  list  keeping  vis  edges  in  */ 

/*  order,  and  then  keeping  hidden  edges  in  order.  If  any  vis  edges  are  */ 

/*  on  the  end  of  the  list,  put  them  on  the  front.  */ 

/*  and  if  so,  put  them  on  the  front,  maintaining  order.  */ 

rotate_edge_list ( [X, Y, v | Rest  J , FullRevisedList)  : - 

rotate_edge_list2 ( [X, Y, v|Rest ] , RevisedList, FrontofList) , 
cons (FrontofList, RevisedList, FullRevisedList) ,  ! . 

/*  Go  past  the  front-end  visible  edges.  */ 

rotate_edge_list2 ( [XI , Yl, v, X2,  Y2 1 Rest J , (XI, Yl, v | L2) , FrontofList)  : - 
rotate_edge_list2 ( (X2, Y2 1 Rest]  ,L2,  FrontofList) ,  ! . 

/*  Go  past  the  first  hidden  edge  after  the  visible  edges.  V 
rotate_edge_list2 ( [XI , Yl , h, X2, Y2 1  Rest ) , [XI, Yl , h I L2J , FrontofList)  : - 
rotate_edge_list3 ( [X2, Y2 1  Rest } ,  L2, FrontofList) ,  I . 

/*  Go  past  the  rest  of  the  hidden  edges  after  the  visible  edges.  */ 
rotate_edge_list3 ( (XI , Yl, h, X2, Y2 1  Rest ) ,  [XI, Yl, h I L2] ,  FrontofList)  • - 
rotate_edge_list3 ( [X2, Y2|Rest) ,  L2, FrontofList) ,  ! . 

/*  If  visible  edges  are  found  past  tha  hidden  edges,  the  rest  will  also  */ 
/*  be  visible;  send  the  rest  back  up  to  be  put  on  the  front  of  the  list  */ 
rotate_edge_list3([X,Y,v|RestJ, (X,YJ, FrontofList)  :- 

ail_but_last_coords ( [X, Y,  v [ Rest  J ,  Trontof List) ,  ! . 

/*  Ending  condition.  */ 
rctate_edge_list3([X,YJ,  [X,YJ,  [))  :-  !. 

/*  eliminate  the  last  coordinates  and  the  last  edge-vis  flag  *f 
all_but_last_coords ( [X,  YJ ,  [ ) ) . 

all_but_last_coords([X, Y,V|Re3tJ, [ X, Y, V | Re vi sedRest J )  :- 
all_but_last_coords (Rest, RevisedRest) . 

/*  mark  edges  before  (b) ,  after  (a),  or  opposite  (o) ,  based  on  whether  */ 

/*  they  are  before  or  after  the  opposite  edge,  or  undetermined.  */ 
mark_edges(Ll,L3)  S- 

mark_edges2  (LI,  1.2) ,  mark_edges3  (L2,  L3) ,  assert_opposite_edge  (L3)  . 

/*  'mark_edges2'  marks  '  h  (b) '  or"”' h  (a) '  based  on  opt  paths  of  edge  itself.  * 
/*  Base  case  for  'mark_edges2' .  */ 
mark_edges2 ( [_,_) , (_,_) ) • 

/*  First  step  past  vis  edges,  leaving  their  markings  unchanged  */ 
mark_edges2 ( [XI, Yl, v, X2, Y2 | Rest) , [XI, Yl, v, X2, Y2 | Rest2 J )  :- 

iTiSr); _ -=dgss2  ( { X2,  Y2  5  Rest ) ,  [X2,  i*2[Rcst2i ;  • 

/*  Upon  finding  a  hidden  edge,  check  if  it  is  'b'  or  'a'  or  'o'  */ 

/*  It  is  'b'  if  opt  path  from  X2,Y2  starts  toward  XI, Yl.  */ 
mark  edges2 ( (XI, Yl , h, X2, Y2 | Rest ) , (XI, Yl, h (b) , X2, Y2 |Rest2) ) 
optimal_path([X2,Y2,c(C),Xi,Yi[  J), 
on_ray  (Xi,  Yi,X2,Y2,Xl,  Yl) , 
mark_edges2 ( [X2, Y2 1 Rest  J , (X2, Y2|Rest2J) . 

/'  It  is  'a'  if  opt  path  from  XI, Yl  starts  toward  X2,Y2.  */ 
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mark_edges2  ( (XI ,  Yl ,  »i,  X2,  Y2 1  Rest  J ,  (XI ,  VI ,  h  (.1) ,  X2,  Y2  |  Rest2  J )  :  - 
optimai_path ( (XI,  Yl,  c (C) ,  Xi,  Yi  l_J ) , 
on_ray (Xi, Yi, XI, Yi, X2, Y2) , 
ir.ark_edges2  ( (X2, Y2|RestJ , (X2, Y2|Rest2J) . 

/*  Otherwise  it  is  potentially  an  opposite  edge,  so  mark  it  with  'o'  */ 
mark_edges2 ( (XI, Y1 , h, X2,  Y2 1  Rest ) , (Xl,Yl,h(o),X2, Y2|Rest2J) 
mark_edgao2 ( (X2, Y2 1  Rost ) , |X2, Y2 1 Rest2 J } . 

/*  mark_edges3  marks  '  b'  or  'a'  based  on  previous  marking  of  adjacent  edges.  */ 
/*  First  step  past  vis  edges,  leaving  their  markings  unchanged  */ 
mark_edges3 ( (X t , Y1 , v, X2, Y2 1  Rest ) , (XI, Yl,v,X2, Y2|Rest2J) 
mark_edges3 ( (X2, Y2 | Rest] , (X2, Y2 | Rest2J ) . 

/*  Now  deal  with  hidden  edges.  */ 

mark_edges3  ( (XI,  Yl,  HI,  X2,  Y2 1  Rest  ] ,  (XI,  Yl,H2,X2,Y2|Rest2]) 

mas:k_edge34  ( (XI,  Yl,  HI,  X2,  Y2 1  Rest  I ,  (XI,  Yl,  l!2,  X2,  Y2  |Rest2J )  . 

/*  Base  case  #1.  End  of  list.  * / 
mark_edges4 ( (X, YJ , (X, Y( ) . 

/*  Base  case  12.  Unknown,  or  as  previously  marked.  */ 
mark_edges4  ( (XI,  Yl,  II,  X2,  Y2) ,  (XI,  Yl,  H,  X2,  Y2J )  . 

/*  Base  case  43.  It  is  'b'  if  next  edge  is  already  'b'.  */ 

mark_edges4  ( (XI ,  Yl ,  h  (o) ,  X2,  Y2,  li  (b) ,  X3 Y3 ) ,  (XI ,  Yl ,  h  (b) ,  X2,  Y2..  h  (b)  ,  X3,  Y3  )>  . 

/*  Base  case  14.  It  is  'a'  if  previous  edge  is  already  'a'.  */ 

mark_edges4  ( 1X1,  Yl,  h  (a) ,  X2,  Y2,  h  (o)  ,  X3,  Y3  f ,  (XI,  Yl,  h  (a)  ,  X2,  Y2,  h  (a)  ,  X3,  Y3J )  . 

/*  Base  case  #5.  It  is  still  potentially  an  opp  edge,  as  previously  marked.  */ 
mark_edges4 ( (XI,  Yl ,  HO,  X2,  Y2,  HI , X3,  Y3J , (XI, Yl, HO, X2, Y2, HI, X3, Y3) ) . 

/*  It  is  'b'  if  next  edge  is  already  'b' .  */ 

mark_edges4  ( (XI,  Yl, h  <o)  ,~X2,  Y2,  h  (b) ,  X3,  Y3|  Rest! , 

(XI,  Yl ,  h  (b) ,  X2,  Y2,  h  (b) ,  X3,  Y3 1 Rest2) )  :  - 

mark_edges4 ( iX2,  Y2,  h (b) ,  X3,  Y3 1 Rest  J , [X2, Y2, h (b) , X3, Y3 1  Rest2] )  . 

/*  It  is  'a'  if  previous  edge  is  already  'a'.  •/ 

mark_edges4  ( (XI,  Yl ,  h  (a) ,  X2,  Y2,  h  (o) ,  X3,  Y3 1  Rest  J , 

(XI,  Yl,  h  (a) ,  X2,  Y.2,  h  (a) ,  X3,  Y3  |  Rest2J  } 

mark_edges4 ( (X2, Y2,  h (a) , X3, Y3 | Rest J , (X2,  Y2,  h (a) , X3, Y3 |Rest2 J ) . 

/*  Otherwise  it  may  be  an  opposite  edge,  so  leave  It  as  previously  marked.  */ 
mark_edges4((Xl,Yl,H0,X2,Y2,Hl,X3,Y3|Rest),  (XI,  Y.l,  HO, X2,  Y2,H2, X3,  Y3 1 Rest2J ) 
mark_edges4((X2,Y2,Hl,X3,Y3|Restl, (X2, Y2, H2, X3, Y3 |Rest2) ) . 

/*  First  step  past  vis  edges  V 
assert_opposite_edge ( (XI, Yl, v, X2, Y2 1 Rest  J) 
asset t_opposite_edge ( (X2, Y2 1 Rest  j ) . 

/*  Second  step  past  h(b)  edges  */ 
assert_opposite_edge ( (XI, Yl,  h (b) , X2,  Y2 1  Rest J ) 
assert_opposi te_edge ( (X2, Y2 | Rest) ) . 

/*  At  first  opposite  edge,  get  rest  of  opp  edge  and  then  assert  in.fo  */ 
asset traopposite_edge ( (XI, Yl, h (o) , X2, Y2 (Rest  J ) 

asset t_opposite_cdge2 ( ( X2, Y2 1  Rest  J , Rest2) , 
i;s»ert(opposite“edge((Xl,Yl,h(o)  |Rest2)J),  I. 

/*  At  first  h(o)  edge,  or  at  end  of  list,  stop.  */ 
assert_opposi.te_edge2  ( (X,  Y) ,  (X,  YJ } . 

assert~opposite"ed9e2((Xl,Yl,h(a) , X2, Y2 IRest J , (X1,Y1J) . 
t*  At  each  h (o)  edge,  get  rest  and  send  back  opp  edge  vertices  */ 
«ssert_opposite_edge2 ( (XI, Yl, h (o) ,X2, Y2 (Rest) , (XI, Yl,h(o) |Rest2J) 
assert_opposite_edgo2 ( 1X2, Y2 1 Rest  j , Rest2) ,  ! . 

/********#*4*4************>*****»****4**4*r**4HH»4MHHHHHHUHHHHUHH*#**##A********4^ 

/'  Succeeds  it  Jst  pt  is  on  a  ray  from  2nd  pt  to  3rd  pt  between  the  two  pt3,  */ 
/*  i  fails  o/w.  Succeeds  If  1«t  pt  -  3rd  pt,  fsi is  if  1-t  pt  =  2nd  pt.  */ 
on  ray  (X2,  Y2,  XI ,  Yl,  X2,  Y2)  . 
on„ray(Xi,Yi,Xl,yi,X2,Y2) 

strict lybetween  (Xi,  XI,  X2) , 
strictly_betwecn (Xi,  Yl, Y2J , 

Yx  is  Xi~(Y2-Yl) / (X2-X1)  1  Y2  -  X2 * (Y2- Yl ) / (X2-X1 J , 
within_tolerance (Xi,  Yx,  Xi, Yi) . 
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/*  Binds  UL  to  the  list  of  opposite  edges.  */ 
get_o_edges{[__,  _,h(v)  |RJ,UL)  o_edges  (R,UL) . 
get_o_edges{(  h(b)  iRJ,Ul.)  o_edgeo(R,  UL)  . 
get”o“edges ( (XI, Yl, h (o) , X2, Y2 |R] , (XI , Yl, X2, Y2 | RestULJ ) 
get_o_edges ( (X2, Y2 | R] , RestUL) . 
get_o_edgesT(„>_/h(a)  |RJ,  (j)  get_o_edges  (R,  ( J )  . 
get_o_edges ((“,_),())• 

order_initbdty_indices 

retract (Initbdry ( (I, Jj , B) J , 
sort ( (I,  JJ , (I2,J2)), 
asserta (initbdry ( (I, Jj , B) ) , 
fail,  i. 

order_initbdryi_indices  !. 
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/**»*«**»*******»*********************»**********»*********•**************»* 

AAAAtfAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA******************************** 

A 

*  File  "bgplotter"  has  the  predicates  which  plot 

*  boundaries  of  various  types.  It  is  loaded  by  "bg". 


/ 


This  predic.  plots  ?.vis/  (Type  1)  boundaries  between  two  .(CA  edges,  ie, 
between  two  visible  edges 

Updated  12  dan  69. 


*  Ci  :  interior  (high)  cost 

*  Ce  :  exterior  (low)  cost  pt  C 

*  Alpha  :  included  angle  of 

*  region  vertex 

*  Beta  :  angle  between  first 

*  edge  (pt  v  to  pt  A)  and 

*  a  line  between  the 

*  vertex  and  the  goal. 

*  Gamma  :  angle  between  second 

*  edge  (pt  V  to  pt  C)  and 

*  a  line  between  the 

*  vertex  and  the  goal. 

*  D1  :  distance  from  goal  to  vertex. 

*  RotAngle  :  angle  needed  to  rotate 

*  the  -X-axis  counterclockwise 

*  to  bring  it  parallel  with 

*  the  first  edge  (V  to  A) 

*  Xa,Ya  :  coords  of  first  point. 

*  Xv,Yv  :  coords  of  second  point, 

*  the  vertex,  connected  to  pt  A 

*  Xc, Yc  :  coords  of  third  point. 

*  Xv2,Yv2  :  if  the  edges  arc  not 

*  connected,  these  axe  the  Here  the  rotation  angle  ~  0. 

*  coords  of  the  "inner”  vertex 

*  of  the  second  edge,  of  which 

*  pt  C  ia  the  other  vertex, 

*/ 

plot_2vis_bdry  (Ci,  Ce,  Xn,  Ya,  Mab,  Xb,  Yb,  Xc,  Yc,  Hcd,  Xd,  Yd) 

virtual_vertex (Xa, Ya, Xb, Yb, Xc, Yc, Xd, Yd, Xvv, Yvv) , 
plot_2vis_bdry_»l  leases  (Ci,Ce,  Hab,  llcd,Xa,  Ya,  Xvv,  Yvv,Xd,  Yd) ,  ! . 
plot_2vis_bdry_allcases (Ci, Ce, Ml, H2, Xa, Ya, Xv, Yv, Xc, Yc)  :~ 

initialire_for_bl,  /*  This  is  a  2v/  or  */ 

goal  point (Xg,Yg) ,  /*  Type  1  boundary.  */ 

pi (Pi), 

distance  (Xv,  Yv,  Xg,  Yg,Dl) , 
distance  (Xv,  Yv, Xc,  Yc, D2) , 
distance (Xa,Ya,Xv,Yv,D3) , 
distance  (Xa,Ya,Xc,  Yc,D4) , 
distune?  Yjv, Xrj,  Yc,  t 

not  (Dl«*0) ,  not(D2**0J ,  not  {D3=0) /*  If  any  of  these  fail,*/ 
not  (D4»0) ,  not  (05*0) ,  /*  *■>  programming  error  or  map  error  */ 

Cosl  Is  (D2A2(D3A2-D4A2)/(2*B2*D3), 
arccos  (Coal,  Alplia) , 

Cos2  is  (OlA2<t'3'*2-D5'“2)  /  (2*D1*D3) . 
arccos  (Co*)2,  Beta) , 

Gamma  is  2*ri  -  Alpha  -  Beta, 


High-Cost  Area 
Interior,  cost  -  Ci 


\Alpha 
Gamma  \ _ 


pt  V 
/  Beta 


pt  A 


Exterior, 
cost  •»  Ce 


/ 

+ 

Goal 
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ThetaCrit  is  asin(Ce/Ci), 

tell  (user),  write  {'2vis  (Type  1)  bdry  being  plotted  between  edges  ' ), 
write  (Ml),  write  ('  and  ' ) , write  (N2)  ,nl, 
checfc_input_for_typel (Alpha, Beta, Gamma, ThetaCrit, Dl) , 
compute_angle_of_rotation (Xv, Tv, Xa, Ta, RotAngle) , 
assert (bdry ((Xv, yvj )) , 

calc_bdry_typel (Alpha, Beta, Ganma, ThetaCrit, Dl,  Xa, Ya, Xv, Yv, Xc, Yc) , 
rotate_bdry (RotAngle) , 
bdry (Bdry) , 

reverse_path_list (Bdry,  RevBdry) , 
truncate_o£ f_map (RevBdry, FinalBdry) , 
assert (initbdry ( (Ml, H2) , FinalBdry) ) , 

/*  tell  (bdry_out) ,  write  ('  Type  1  '),nl, 
write_to_bdry_£ile (bdry, Bdry,Nl,N2) ,nl, 
output  to  figure  file,  */ 

i .  —  “ 

plot  _2vis_bdry_allcases (_,  ,  ,_,  ,,,):- 

initialize  for  bl  : - 

aoolish (done, 0) , 
abolish (bdry, 1) , 
abolish (thetal,l),  !. 

calc_bdry_typel  (A,  B, G, Tc, Dl,  Xa,  Ya,  Xv,  Yv, Xc,  Yc)  : - 
Pi (Pi), 

9et_Tl_range  <G,  Xv,  Yv, Xc,  Yc, Tlmin, Tlmax) , 
precision (Precision) , 

DelTl  is  (Tlmax-X.lmin)  /  (Precision/2) , 

Tlinit  is  Tlmin  -  DelTl/2,  /*  let  1st  point  be  closer  to  vertex  */ 
assert (thetal (Tlinit) ) ,  / 

retract  (tlietal  (Tlprev)  )  , 

T1  is  Tlprev  +  DelTl, 

T1  <  Tlmax+0.01, 

T1  <  Pi/2, 
assert (Uhetal(Tl)), 

calc_bdryl_pt(Dl,Tl,A,B,G,Tc,T3,T4,Yl,Y2), 

store_2vis_results (-T3, -T4, Yl, Y2, B, Dl, Xv, Yv) , 
done,  ! . 

ca!c_bdry_tyPel 


calc_bdry  l_pt  (Dl ,  T1 ,  A,  B,  G,  Tc, 

T3,T4,Y1,Y2) 
abolish (donel, 0) , 
abolish (theta3,l), 
abolish  (increment,  1) , 
pi(Fi), 

Initlncr  is  -(Pi-B)/2,  /*  1/2  of  range  of  Theta3 

assert (increment (Initlncr) ) , 

T3init  is  B- (Pi/2) , 
assert (theta3 (T3init) ) , 
retract  (theta3  (T3) ) , 

calc_Cpsilon  (Dl,  T1 ,  A,  B,  G, Tc,  T3,T4,  Yl,  Y2,  E) , 
get_direction (E, Direction) , 

9«<-_T3new  (Direction,  T3,  T3new.  Incr) , 
assert  (theta3  (T3new) ) , 
donel,  ! . 


*/ 


virtual  v«t»*IXt,Vl,V9  vo  vi  vi  .....  . 

line_intersection (XI, Yl , X2, Y2, X3, Y3, X4, Y4, 

/* 


/-  the  virtual  vertex  Is 
Xv,Yv),|.  /♦  the  point  of 
intersection  of  the  lines. 


*/ 

•V 

*/ 


9'!t_TJ.r «ng*  (G,  Xv,  Yv,  Xc,  Yc,  Tlinit,  Tlfinal)  : - 
pi(Fi). 
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Tlinit  is  G-Pi/2, 
goal_point  (Xg,  Yg) , 
distance  (Xg,  Yg,  Xv,  Tv,  Dl) , 
distance  (Xc,  Yc, Xv,  Yv, D2) , 
distance  (Xg,  Yg,  Xc,  Yc, D3) , 

Cos  is  (D2A24D3A2-D1A2)/{2*D2*D3), 

arccos (Cos, Angle) , 

get_Tl final (Angle, T1 final) ,  ! . 


get_Tlfinal (Angle, Tifinal) 
Angle  >  0.05, 
pi (Pi), 


Tifinal  is  Pi/2  -  Angle,  !. 
getjrifinal  (Angle, Tifinal)  / 

Angle  -<  0.05, 

Pi (Pi), 

Tifinal  is  ((Pi/2  -  Angle) + (Pi/2) ) /2, 


MaJee  Thetal 


I . 


a 


little 


larger 


*/ 


get_direction (E, minus)  :- 
E  >  0.001,!. 

get_direction(E,  plus)  :- 
E  <  -0.001, ! . 

get__direction(E,done) 

assert  (done!) ,  }. 


9*t_T3new (done,  ,  ,  )  •-  i. 

get_T3new(pius,T37T3neK,incr) 

increment (Incr), 
in or  <  0, 

T3new  is  T3-Incr, 

Half Incr  is  -Incr/2, 
retract (increment (  ) ) , 
assert (increment (Half incr) ) , 

get_T3new (plus, T3,T3new, incr) 

retract (increment (Incr) ) , 
T3new  is  T34Incr, 
assert (increment (Incr) ) ,  I . 
gst_T3new (minus, T3,  T3new, Incr)  : - 
increment (Incr) , 

Incr  >  0, 

T3new  is  T3-Incr, 

Halflncr  is  -Incr/2, 
retract  (increment (  )), 
assert (increment (Half incr) ) , 
9etJr3new  (minus,  T3,  T3new,  incr)  : - 
retract  (increment  (Incr) ) , 
T3new  is  T34Ir.cr, 
assert (Increment (Incr) ) ,  J. 


/*  direction  of  search  */ 
/*  lias  changed,  halve  the  */ 
/*  incr  c  change  signs,  */ 
/*  otherwise  don't.  */ 


/*  If  direction  of  search  */ 
t*  •••»  changed,  halve  the  */ 
/*  incr  £  change  signs,  */ 
/*  otherwise  don't.  »/ 

!, 


calc_Epsilon  (Dl ,  Tl ,  A,  B,  G,  Tc,  T3, T4 ,  Yl,  Y2,  E) 
T2  is  asin  (sin  (Tc)  *sin  (Tl) ) , 

T4  is  asin  (sin  (Tc)  »sin(T3)), 

SlnTc  is  sin (Tc) , 

XI  is  DJ  »sin (G) /cos (Tl) , 

Tl  is  Dl  *sin  (3)  /cos  (T3)  , 

A1  is  Dl 'sin (A) /cos (T2) , 

A2  is  D.l'sln  (A)  /cos  (T4) , 

BI  is  cos (Tl-G) /cos (Tl) , 

B2  is  ceo  (T24A)  /cos  (T2) , 

S3  is  cos  (T3-B)  ,’cos  |t3)  , 

BI  is  COS (T41A) / cos (T4) , 

X2  Is  Al*  (B3-B1'B4)  /  (l-B2*B‘l), 

T2  is  A2*fil-  (X2'cos  (T21A)  /cos  (T4) ) , 
Mis  1?  SinTc*Xl  1  X?, 
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Rhs  is  SinTc*Yl  4  Y2, 

E  is  Lhs-Rlis,  I.  /*  E  >  0  If  Cost  (X-path)  >  Coot  (Y-path)  */ 

check_input  £or_typel  (A,  B,  G,Tc,Dl)  s- 
pi  (Pi) , 

A  >  0,  A  <  Pi, 

B  >  Pi-A,  B  <  Pi, 

G  >  Pi-A,  G  <  Pi, 

Tc  >  0, 

Tc  <  Pi/2, 

Dl  >  0,  !  . 

check_input_for_typel  (Alpha,  Beta,  Gamma,  Thetacrit,  Dl) 
convert_rads_to_degr  (Alpha, AlphaDeg) , 
convert_rads_to_degr (Beta, BetaDeg) , 
convert_rads_to_degr (Gamma, GammaDeg) , 
oonvert_rads_to_degr  (Thetacrit, ThetacritDeg) , 
tell (user) , 

write  ('  ERROR  in  type  1  input:  A-' ), 

write (AlphaDeg) , 

write  ('  B-'), 

write (BetaDeg) , 

write  ('  G-'), 

write (GammaDeg) , 

write  ('  Dl-*'), 

write (ThetacritDeg) , 

write  (Dl) ,  nl, 

fail,  1. 

* 

*  This  predict  draws  lvis  (Type  2)  boundaries,  ie,  boundaries  between 

*  one  visible  and  one  hidden  IICA  edge. 

* 

*  Updated  31  -Jan  89 

* 

*  "plot_lvis_bdry"  draws  a  boundary  for  edge  1  visible  and  edge  2  hidden; 

*  "plotbdry2_inv"  draws  a  boundary  for  edge  2  visible  and  edge  1  hidden; 

* 

*  pt  D 

*■  Ci  :  interior  (high)  cost  / 

*  Ce  :  exterior  (low)  cost  /  High-Cost  Area 

*  Alpha  :  included  angle  between  pt  PI  /  Interior,  cost  *»  Ci 

*  the  two  edges.  /: 

*  Beta  :  angle  between  first  /  ; 

*  edge  (pt  V  to  pt  A)  and  /  :  Alpha 

*  a  line  between  the  ft  C  \  : 

*  vertex  and  the  goal.  \:Gamma 

*  XI  :  distance  from  goal  to  vertex.  : _ 

*  Angle  :  angle  needed  to  rotate  pt  B  \  pt  A 

*  the  x-axis  counterclockwise  .  Beta 

*  to  bring  it  parallel  with  \ 

*  the  first  edge  (V  to  A)  .  Exterior, 

*  Xv, Yv  :  coords  of  second  point,  \  cost  ■*  Ce 

*  the  vertex.  4 

*  Goal 

+ 

*  Here  the  rotation  angle  "  0 


plot_lvis_bdry  (o,Ci,Ce,Xa,  Ya,Hsb,Xb,Yb,  Xc,Yc,Hcd,  Xd,  Yd)  /*  Opposite  edge.  */ 
not (opposite_point (Xc, Ye* ) , 

pseudo_optimal_path ( |Xc, YclOPc) ) ,  /*  lst-pass,  no  shortcutting  */ 

counterclockwise ( (Xc, YolOrc) ) ,  /*  If  before  opposite  point.*/ 
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tell  (user) , 

write ('lv/b  (Type  2)  bdry  being  plotted  between  edges  '), 
write  (Nab) ,  write  ('  and  '),  write  (Med) ,  nl, 

goal  point (Xg, Yg) ,  /*  lv/-  (Type  2)  bdry  */ 

t ranslate_line  (Xb,  Yb,  Xc,  Yc,  Xd,  Yd,  Xdtr,  Ydtr) , 

path_length ( (Xc, Yc|OPc( ,D1) , 

distance  (Xb,  Yb,  Xc,  Yc,  D2calc) , 

add_epsilon_if_*ero (D2calc, 02) , 

distance  (Xb,  Yb,  Xg,  Yg,  03) , 

distance (Xc, Yc, Xd, Yd, Dcd) , 

distance  (Xa,  Ya,  Xb,  Yb,  Dab) , 

distance (Xa, Ya, Xg, Yg, Oag) , 

distance (Xa,  Ya, Xdtr,  Ydtr,  Oadtr) , 

distance (Xa, Ya, Xc, Yc, Oca) , 

Coal  is  (DcdA24DabA2-DadtrA2)/(2*Dcd*Dab), 
arccos (Coal, AlphaAbs) , 

sign_of  Alpha (AlphaAbs, Xa, Ya, Xb, Yb, Xc, Yc, Xd, Yd, Alpha) , 

Cos2  is- (D3A24DabA2-DayA2) / (2*D3»Dab) , 
arccos (Cos2, Beta) , 

Cos3  is  (D2A2‘DabA2-DcaA2) / (2*D2*Dab) , 
arccos (Cos3, Gamma) , 

compute_angle_o£_rotation (Xd, Yd, Xc, Yc, RotA) , 
connected (Xa, Ya, Xb, Yb, Xc, Yc, Xd, Yd, Conn) , 
plot_lvis_bdry2 (before, Conn, Ci, Ce, Nab, Ned, 

Alpha, Beta, Gamma, D1 , 02, 03, 

Dag,  Dab,  Xc,Yc,  RotA) ,  !. 

plot_lvis_bdry (o, Ci, Ce, Xa, Ya,Nab, Xb, Yb, Xc, Yc,Ncd,Xd, Yd)  t-  /*  opposite  edge  */ 
-  pseudo_gptimal_patIt((Xd,  YdjOPdJ),  /*  Must  be  after  opp  pt  »/ 

tell  (user) , 

write  ('lv/a  (Type  2)  bdry  being  plotted  between  edges  '), 
write  (Nab) ,  write  ('  and  '),  write  (Ned)  ,nl, 

goal_point (Xg, Yg) ,  .  /*  lv/-  (Type  2)  bdry  »/ 

t ranslate_line (Xa, Ya, Xd, Yd, Xc, Yc, Xctr, Yctr) , 

path_length ( (Xd, Yd(OFd) ,D1) , 

distance (Xa, Ya, Xd, Yd, D2calc) , 

add_epsilon_i£_iero (D2calc, 02) , 

distance  (Xa,  Ya,Xg,  Yg,  D3) , 

distance (Xc, Yc,Xd, Yd, Dcd) , 

distance (Xa, Ya, Xb, Yb, Dab) , 

distance  (Xb,  Yb,  Xg,  Yg,  Dbg) , 

distance  (Xb,  Yb,  Xctr,  Yctr,  Dbctr) , 

distance (Xb, Yb, Xd, Yd, Ddb) , 

Coal  is  (DcdA2408bA2-DbctEA2) / (2*0cd*Dab) , 
arccos (Cosl, AlphaAbs) , 

sign  of  Alpha  (AlohaAbs,  Xb,  Yb,  Xa,  Ya,  Xd,  Yd, Xc,  Yc,  Alpha) , 

Cos2~ is""  (D3A240abA2-DbgA2)  /  <2*D3‘Dab) , 
arccos (Cos2, Eeta) , 

Cos3  is  (D2A24DabA2-OdbA2)/(2*D2*Dab), 
arccos  (Cos3,Garrr»3) , 

compute_angle_o£_rotation (Xd, Yd, Xc, Yc,  RotA) , 
connected  (Xa,  Ya,  Xb,  Yb,  Xc,  Yc,  Xd,  Yd,  Conn)  , 

plot  lvis  bdry2  (after.  Conn,  Ci,Ce,  Neb,  Ned,  Alpha,  Beta,  Gamma, 

01, 02,  D3,  Dbg, Dab, Xd, Yd, RotA) , ! . 

plot_lvis_bdry (b, Ci, Ce, Xa, Ya, Nab, Xb, Yb, Xc, Yc, Ned, Xd, Yd)  /*  before  opp  edge  */ 
~  optimal_path ( (Xd, Yd,  c (C) , Xpl,  Ypl | F) ) , 

counterclockwise  ( |Xd.,  Yd,  c  (C) ,  Xpl,  Ypl  IP) ) , 

tell  (user),  write('lv/b  'Type  2)  l>dry  being  plotted  between  edges  '), 
write  (Nab) ,  write  ('  and  '),  write  (Hcd) ,  nl, 

goal  point (Xg,Yg) ,  /*  lv/-  (Type  2)  bdry  »/ 

translate_line  (Xb,  Yb,  Xc,  Yc,  Xd,  Yd,  Xdtr,  Ydtr) , 
distance (Xd,  Yd,  Xpl , Ypl, Ddp) , 

333ert_sliortcut_£lag  (Xc,  Yc,  Xpl,  Ypl) , 


248 


pach_length ( I  Xpl,  Ypl |P) , Dl) , 
distance  (Xb,  Yb,  Xpl,  Ypl,  D2calc) , 
add  epsilon  if  zero (D2calc, D2) , 
distance  (Xb7Yb7xg,  Yg,  D3) , 
distance  (Xc,  Yc,  Xd,  Yd,  Ocd) , 
distance  <Xa,  Ya,  Xb,  Yb,  Dab) , 
distance (Xa,  Ya,  Xg, Yg, Dag) , 
distance  (Xa,  Ya,Xdtr,  Ydtr,  Dadtr) , 
distance (Xa,  Ya,  Xpl, Ypl, Dpla) , 

Coal  is  (DcdA24DabA2-DadtrA2)/(2*Dcd*Dab), 
arccos (Cosl, AlphaAbs) , 

sign  of_Alpha  (AlphaAbs,  Xa,  Ya,  Xb,  Yb,  Xc,  Yc,  Xd,  Yd,  Alpha) , 

Cos2_ is  (D3A2JDabA2-DagA2)  /  (2*D3*Dab) , 
arccos (Cos2, Beta) , 

Cos3  is  (D2A24DabA2-DplaA2)/(2*D2*Dab), 
arccos  (Cos3, Ganna) , 

compute_angle_of_rotation (Xd,  Yd,  Xc,  Yc,  RotA) , 
connected  (Xa,  Ya,Xb,  Yb,  Xc,  Yc,Xd,  Yd,  Conn) , 

/*  changed  Xc, Yc  for  Xpl, Ypl  */ 
plot_lvis_bdry2  (before, Conn,  Ci,  Ce,  Nab,  Ned,  Alpha, Beta, Gamme, 

Dl,  D2,D3,  Dag,  Dab,  Xpl,  Ypl,  RotA)  ,! . 

plot_lvis_bdry  (a,Ci,Ce,Xa,  Ya,Nab,Xb,  Yb,  Xc,  Yc,Ncd,  Xd,  Yd)  /*  after  opp  edge  */ 
optimal  path ( (Xc, Yc, c(C) , Xpl, Ypl IP)) , 

clockwise ((Xc,Yc,c(C), Xpl, Ypl |PJ),  /*  discriminates  btwn  OP'S  */ 

/*  in  opposite  directions  from  opp  pt.  */ 
tell (user),  write ('lv/a  (Type  2)  bdry  being  plotted  between  edges  '), 
write  (Nab) ,  write  ('  and  '),  write  (Ned) ,  nl, 

goal_point (Xg, Yg) ,  /*  lv/-  (Type  2)  bdry  */ 

t  r anslate_line (Xa, Ya, Xd, Yd, Xc, Ye, XcUr, Yctr) , 

distance  (Xc,  Yc,Xpl,  Ypl,Dcp) , 

assert_shortcut_f lag (Xd,  Yd,  Xpl,  Ypl ) , 

path_length ( [Xpl, Ypl IP] , Dl) , 

distance (Xa, Ya,Xpl, Ypl,  D2calc) , 

add_epsilon_if_xero (D2calc,  D2) , 

distance (Xa, Ya,Xg, Yg,D3)  , 

distance (Xc, Yc, Xd, Yd, Dcd) , 

distance  (Xa,  Ya,  Xb,  Yb,  Dab) , 

distance  (Xb,  Yb,  Xg,  Yg,  Dbg) , 

distance (Xb,  Yb,Xctr, Yctr,Dbctr) , 

distance  (Xb,  Yb,Xpl,  Ypl, Dpi b) , 

Cosl  is  (Dcd''2+Dab''2-Dbctr A2)  /  (2*Dcd*Dab) , 
arccos (Cosl, AlphaAbs) , 

sign  of  Alpha  (AlphaAbs,  Xb,  Yb,  Xa,Ya,Xd,  Yd, Xc,Yc,  Alpha) , 

Cos2  is  (D3A24DabA2-DbgA2) / (2*D3‘Dab) , 
arccos (Cos2, Beta) , 

Cos3  is  (D2A24DabA2-DplbA2) / (2*D2*Dab) , 
arccos (Cos3, Gamma) , 

compute_angle_of_rotation (Xd, Yd, Xc, Yc, RotA) , 
connected  (Xa,  Ya,  Xb,  Yb,  Xc,  Yc,  Xd,  Yd,  Conn) , 

/*  changed  Xd,Yd  for  Xpl, Ypl  (why  Xd,Yd?7?)  */ 
plot_lvis_bdry2 (af  er, Conn, Ci, Ce, Nab, Ned, Alpha, Beta, Gamma, 

Dl,  D2,D3,  Dbg,  Dab,  Xpl,  Ypl,  RotA) ,! . 

/*  Pl°t_lvis_bdry  s-  !  .  */ 

plot_l vis_bdry2  (before, Conn,  Ci,  Ce,  111,  N2,  A,  B,  G,  Dl,  D2,  D3,  Dag,  Dab,  Vx,  Vy,  RotAngle)  : - 
abolish  (bdry, 1) , 
abolish (Hooe^O) , 
abolish (thetal, 1) , 

ca lc_i vis_bdry  (Ci,  Ce,  A,  B,  G,  Dl,  D2,  D3,  Dag,  Dab,  Vx,  Vy) , 
rotate_bdry  (P.otAngle) , 

remove_last_bdry_coord_if_disconnected (Conn) , 
bdry  (Bdry) , 

reverse_pat,h_list  (Bdry,  RevBdry) , 
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truncate_of £_map (RevBdry, FinalBdry) , 
assert (initbary ( [HI, H2) , FinalBdry) ) , 

/*  tell  (bdry_out) ,  write  ('  Type  2  '),nl, 

write_to_bdry_f ile (bdry, Bdry) , 
output_to_figure_file,  */ 

! . 

plot_lvis_bdry2 (after ,  Conn, Ci, Ce, HI, H2, A, B, G, nl, D2, D3, Dbg, Dab, Vx, Vy, RotAngle) 
abolish (bdry, 1) , 
abolish (done, 0) , 
abolish (thetal, 1) , 

calc_lvio_bdry  (Ci,  Ce,  A,  B,  G,  D1 ,  D2,  D3,  Dbg,  Dab,  Vx,  Vy) , 

invert_bdry, 

rotatejbdry (RotAngle) , 

remove_last_bdry_coord_i£_disconnected (Conn) , 
bdry (Bdry) , 

reverse_path_list (Bdry, RevBdry) , 
truncate_of f_map (RevBdry, FinalBdry) , 
assert (initbdry ( [HI , H2) , FinalBdry) ) , 

/*  tell  (bdry_out) ,  write  ('  Type  2-inv  *  ),nl, 

write_to_bdry_£ile (bdry, Bdry) , 
output_to_£igure_file,  */ 


calc_lvis_bdry (Ci, Ce, A, B, G, D1 , D2, D3, Dag, Dab, Vx, Vy )  : - 
assert (bdry ( (Vx, Vy) ) ) , 
maxX  (XMax)  ,  minX  (XMin) , 

LargeHumber  is  (XMax  -  XMin) *100, 
assert (sc_bdry_pt_dist (LargeHumber) ) , 

CostRatio  is  Ce/Ci, 

Tc  is  asin (CostRatio) , 
get_tlmin (Dag, Dab, D3, Tlmin) , 
get_tlmax(B,Tlmax) , 
precision (Precision) , 

DelTl  is  (Tlmax-Tlmin) /Precision, 

Tlinit  is  Umax  4  DelTl, 
assert (thetal (Tlinit) ) , 
retract (thetal (Tlprev) ) , 

T1  is  Tlprev  -  DelTl, 

T1  >”  Tlmin, 
assert (thetal (Tl) ) , 

calc_lvis_bdry_pt (Tc, A, B, G, Dl, D2, D3,T1, XI, X2) , 
store_lvis_results (Xl,X2,Tc,Vx, Vy) ,  fail. 
calc_l vis_bdry  (_,  _,  _,  _,  _,  _, _,  _, _,  _, _,_)  :  - 
abolish (sc_bdry_pt_dist, 1) ,  !. 

get  tlmin  (Dag,  Dab,  D3,Tlmir,) 

pi  (Pi), 

Cosl  is  (DagA24Dab*2-D3A2)/(2*Dag*Dab), 
arccos (Cosl.Tlminplus9C) , 

Tlmin  is  Tlminplus90  -  Pi/2,  ! . 
get_tlma>:  (B,Tlmax) 
pi  (Pi) , 

HinetyminusB  io  Pi/2  -  B, 

Tlmax  is  HinetyminusB,  ! . 

calc_l  vis_bdry_pt  (Tc,  A,  B,  G,  Dl ,  D2,  D3,  Tl,  XI ,  X2)  : - 
~  T2  is  asin  (sin  (Tl)  *sin  (Tc) ) , 

TlolusB  is  Tl  4  B, 

TcplusAminusT2  is  Tc  4  A  -  T2, 

T2minusA  is  T2  -  A, 

T2minusG  is  T2  -  G, 

Fl  is  sin  (A)  -  cos  (T2)  *sin  (Tc) , 

X2  is  (-D1  *sin  (Tc)  *cos  (T2)  ‘cos  (T2minusA) 

4D2*  (cos  (T2minuoA)  *sin  (G)  -cos  (T2minusG)  ''F.l ) 
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4I)3‘  (cos  (T2)  /cos  (Tl)  >  * 

(sin  (B)  *sin  (Tc)  *cos  (T2mir.usA)  +cos  (TiplusB)  *F1) ) 
/ (sin (TcplusAminusT2) *F1 

+cos (T2minusA) * (cos (Tc+A) +cos (T2) ) ) , 

XI  is  -X2* (sin (TcplusAminusT2) /cos (T2minusA) ) 

-D2* (cos (T2minusG) /cos (T2minu«A) ) 

+D3* (cos (T2) *cos (TiplusB) / (cos (Tl) *cos (T2minusA) ) ) ,  ! . 

translate  line (Xref, Yref,Xl, Yl, X2, Y2, X2trans, Y2trans) 

DelX  is  Xl-Xref , 

DelY  As  Yl-Yref, 

X2trana  is  X2  -  DelX, 

Y2trans  is  Y2  -  DelY,  ! . 


next  to  last  pt ( (X, Y, Xlast, Ylast] , (X, Y] ) . 
next~to~last”pt ( (XI, Yl |R] , (X,Y1) 

next_to_last._pt  (R,  (X,  YJ ) ,  ! . 

store_lvis_results  (Xl,X2,Tc,  V.*s,  Vy) 
not (shortcut (  ,  ,Vx,Vy)), 

Xbdry  is  Vx  -~xl  -  X2*sin(Tc), 
Ybdry  is  Vy  +  X2*cos (Tc) , 
retract (bdry {BList) ) , 
assert (bdry ( (Xbdry, Ybdry I BList] ) ) , 
3tcre_lvis_£esult„ (XI, X2, Tc, Vx, Vy)  : - 
shortcut (_, _, Vx, Vy) , 

Xbdry  is  Vx~-  XI  -  X2*sin(Tc), 
Ybdry  is  Vy  f  X2*cos (Tc) , 
distance (Xbdry, Ybdry, Vx, Vy , Dnew) , 
sc_bdry_pt_dist (Dold) , 

Dnew  >~  Dold, 

retract (sc_bdry_pt_dist (Dold) ) , 
assert (sc_bdry_pt_dist (Dnew) ) , 
retract (bdry (BList) ) , 
assert (bdry ( (Xbdry, Ybdry I BList  J ) ) 
stcre_lvis_results  ()'.l,X2,Tc,Vx,  Vy) 
shortcut (  ,_, Vx,Vy), 

Xbdry  is  Vx“-  XI  -  X2*sin(Tc), 
Ybdry  is  Vy  +  X2*cos(Tc), 
distance (Xbdry, Ybdry, Vx, Vy, Dnew) , 
retract (sc_bdry_pt_dist (Dold) ) , 
Dnew  <  Dold, 

assert (sc_bdry_pt_dist (Dnew) ) ,  ! . 


! . 

/*  The  effect  of  rules  2  t  3  */ 

/*  is  to  exclude  the  initial  */ 
/*  portion  of  a  bdry  which  */ 
I*  starts  at  a  s/c  pt,  as  long*/ 
/*  as  the  bdry  is  coming  back  */ 
/*  toward  the  s/c  pt,  and  */ 
/*  include  the  later  portion  »/ 
/*  as  it  goes  away  from  it,  */ 
/*  since  thetamax  ,ls  calculated*/ 
/*  for  the  non-s/c  case  and  is*/ 
f.  /*  too  large  for  the  s/c  case.*/ 


/*  If  edge  AB  is  parallel  to  CD,  AlphaAbs  will  be  0,  so  Alpha  is  0.  */ 
sign_of_Alpha  (0,  Xa,  Ya, Xb,  Yb,  Xc,  Yc,  Xd,  Yd,  0)  . 

/♦  If  AD  intersects  CD  on  the  B-side  of  AB,  Alpha  is  positive.  */ 
sign  o£_Alpha (AlphaAbs, Xa, Ya, Xb, Yb, Xc, Yc,Xd, Yd, AlphaAbs) 

~line_  inter  section  (Xa,  Ya,  Xb,  Yb,  Xc,  Yc,  Xd,  Yd,  Xi,  Yi)  , 
distance (Xi, Yi.Xa, Ya, Dia) , 
distance  (Xi,  Yi,  Xb,  Yb,  Dib)  , 

Dia  >“  Dib. 

/*  Otherwise,  AB  intersects  CD  on  the  A-side  of  AB  and  Alpha  is  negative.  */ 
s.lgn_of_Alpha  (AlphaAbs,  Xa,  Ya,  Xb,  Yb,  Xc,  Yc,Xd,  Yd,  -AlphaAbs)  . 

/‘If  X"0,  return  a  slightly  positive  value,  else  leave  X  unchanged  */ 
add  epsilon  if  tero (0,0.0001) • 
add_epaiion_i£_rero (X,  X) . 

/*  returns  Conn  «  conn  if  the  two  line  segments  are  connected,  */ 

/*  and  Conn  ••  disc  otherwise.  */ 
connected  (Xa,  Ya,Xb,  Yb,Xc,  Ye,  Xa,  Yo,conn)  . 
connected  (Xa,  Ya,  Xb,  Yb,  Xb,  Yb,  Xd,  Yd,  conn)  . 
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connected  (Xa,  Ya,  Xb,  Yb,  Xa,  Ya,  Xd,  Yd,  conn)  . 
connected  (Xa,  Ya,  Xb,  Yb,  Xc,  Yc,  Xb,  Yb,  conn)  . 
connected  (Xa,  Ya,  Xb,  Yb,  Xc,  Yc,  Xd,  Yd,  disc)  . 

/*  It  the  two  edges  arc  not  connected,  the  first  point  in  the  */ 
/*  Edry  list  is  not  part  o £  the  boundary,  but  only  there  to  */ 

/*  specify  the  point  about  which  to  rotate.  */ 
remove_last_bdry_coord_i£_diaconnected  (conn)  . 
remove_l«at_bdry_coord_iC_disconnected (disc) 
retract (bdry (Bdry) ) , 

reverse_path_J ist (Bdry, (X, Y( ReversedBdry ) ) , 
reverse_path_list (ReversedBdry, RevisedBdty) , 
assert (bdry (RevisedBdry) ) . 


. . . . . . . 

* 

*  Plot  Ovis  boundaries,  between  two  hidden  edges. 

* 

*  Updated  12  Jan  89. 

*/ 

plot_Ovis_bdry  (b,  b,  Ci, Ce,  Xa,  Ya,  Nab,  Xb,  Yb,  Xc,  Yc,  Ned,  Xd,  Yd)  : - 

tell  (user),  l*  'before'*  compared  with  'before'  */ 

write (' Ov/M(b)  (Type  3)  bdry  being  plotted  between  edges  '), 
write(Nab),write('  and  ' ) , write (Ned) ,nl, 
abolish (bdry, 1) , 

optimal_path ( ( Xd, Yd, c (Co) , Xpl , Ypl | OFpl ) ) , 
counterclockwise ( (Xd, Yd, c (Ca) , Xpl, Ypl lOPpl ) ) , 
path_length ( (Xpl, Ypl |OFplJ,Dplg) , 
optimal_path ( [Xb, Yb, c (Cb) ,  Xp3, Yp3 |OPp3 J ) , 
path_length ( (Xp3, Yp3|OFp3) , 01) , 

02  is  Dpiy  -  01, 
distance (Xa, Ya, Xb, Yb, Dab) , 
distance (Xa,  Ya, Xpl, Yp), 03) , 
distance (Xb, Yb,Xpl, Ypl, Dbpl) , 
di stance (Xd, Yd, Xpl , Ypl , Ddpl ) , 
distance (Xa, Ya, Xd,  Yd, Dad) , 
distance (Xc,  Yc, Xd, Yd, Bed) , 
distance (Xp3, Yp3, Xa, Ya, Z) , 
pi (FA) , 

Cosl  is  (D3',24Dab''2-Dbpl''2)  /  (2‘03*Dab) , 
arccos (Cosl, A) , 

Cos2  is  (Ddpl'*2»D3~2-DadA2)/(24Ddpl*D3), 
arccos (Cos2, PiminusBeta) , 

B  is  Fi  -  FiminusOote, 

Tc  is  asin(Ce/Ci) , 

computc_ongle_o£_  rotation  (Xd,  Yd,  Xc,  Yc,  Rot  Angle) , 
calc  bdry_pt_OvisM(A,  B,Tc,  Xpl ,  Ypl ,  S,  Dl ,  D2,  D3,  0,  X2bdry,  Y2bdry) , 
calc_bdry_pt_OvisM(A,  B,  Tc,  Xpl ,  Ypl ,  Z,  D1,D2,  D3,  Dcd,X3bdry,  Ylbdry) , 
abolish  (bdry,  1 ) , 

assert (bdry ( (XI bdry, Ylbdry,X2bdry, Y2bdry,Xpl, Ypl J ) ) , 
rotate?,  bdry  (RotAnole) , 

bdry ( |xl, Y1 , X2, Y2) j , 

correct_etrot  In  conn  edges  (Xb,  Yl*,Xc,  Yc,  Xpl,  Ypl, X2,  Y2,  X2r,  Y2r) , 
assert (Initbdry (7»ab, Ned j , |X2r , Y2r , XI , Y1 J ) ) ,  ! . 

plot_vvi  s_l*tiry-  to,  a,  cl ,  Ce,  Xa,  Ya,  Nab,  Xb,  Yb,  Xc,  Yc,  Ned,  Xd,  Yd) 

tell (user) ,  /*  'after'  compared  with  'after'  */ 

writo('0v/M(a)  (Type  3)  bdry  being  plotted  between  edges  '), 
writ  e  (|lab) ,  wri  te  ('  end  '),  write  (Ned) ,  nl, 
abed  i  sli  (bdry,  J ) , 

r.ptimal_patli(  (Xc,  Yc,  c  (Cc) ,  Xp3,  Yp3  |0Fp3  J ) , 
path_length ( I Xp3, Yp3 I OFp3 1,01), 
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optimal  path ( (Xa, Ya, c (C) , Xpl, Ypl |OPpl ] ) , 
clockwise! [Xa, Ya, c (C) , Xpl , Ypl |OPpl J ) , 
path_lenoth ( [Xpl,  Ypl |C?pl)  ,Dplg)  , 

D2  is  Dpig  -  Dl, 
distance (Xa, Ya, Xb, Yb, Dob) , 
distance  (Xd,  Yd,  Xpl,  Yp.l,  D3) , 
distance (Xa, Ya, Xpl , Ypl , Dapl) , 
distance  (Xc,  Yc,  Xpl,  Ypl,  Dcpl) , 
distance (Xa, Ya, Xd, Yd, Dad) , 
distance  (Xa,  Ya,  Xb,  Yb,  Dab) , 
distance (Xc, Yc, Xd, Yd, Dcd) , 
distance (Xp3, Yp3, Xd, Yd, Z) , 
pi(Fi), 

Cosl  is  (D3A2  fDcd/',2-DcplA2)  /  (2*D3*Dcd> , 
arccos (Cosl, A) , 

Cos2  is  (DaplA2iD3A2-DadA2)/(2*Dapl‘D3), 
arccos (Cos2, PiminusBeta) , 

B  is  Pi  -  PiminusBeta, 

Tc  is  asin(Ce/Ci), 

compute_angle  of  rotation (Xb, Yb, Xa, Ya, RotAngle) , 
calc  bdry  pt  OvisM (A,  B, Tc,  Xpl,  Ypl,  Z, Dl, D2, D3,  0, Xlbdry,  Ylbdry) , 
calC_bdry3tT0vi3H (A, B, Tc,  Xpl,  Ypl,  Z,  Dl,  D2,  D3, Dab, X2bdry, Y2bdry) , 
abolish (bdry, 1) , 

assert (bdry ( [X2bdry, Y2bdry, Xlbdry, Ylbdry, Xpl, Ypl) ) ) , 

invertjbdry, 

rotate2_bdry (RotAngle)  , 

bdry ( (XI, Yl, X2, Y2] ) , 

cor rect_error_in_conn_edges (Xb, Yb, Xc, Yc, Xpl , Ypl , X2, Y2, X2r, Y2r ) , 
assert  (initbdry  ( [Hab,  lied  J ,  (X2r ,  Y2r,  XI,  Y1 ) ) ) ,  ! . 


plot_0vis_bdry  (b,  a,  Ci .  Ce,  Xa,  Ya,  Nab,  Xb,  Yb,  Xc,  Yc,  Hcci,  Xd,  Yd)  :  - 

tell (user),  /*  'before'  compared  with  '»ft«r'  */ 

write ('Ov/D  (Type  4)  bdry  being  plotted  between  edges  '), 
write (HabJ , write ('  and  '), write (Hcd) , nl, 
abolish (bdry, 1) , 

optin3l_path ( [Xb, Yb, C (Cl) , Xpl, Ypl lOPpl J ) , 

counterclockwise  ( [Xb,  Yb,  c  (Cl) ,  Xpl,  Ypl  lOPpl  J ) , 

path_length ( [Xpl, Ypl lOPpl J , Dl) , 

optimal  path ( [Xc, Yc, c (C2) , Xp2, Yp2 IOPp2] ) , 

clockwise ( [Xc, Yc, c (C2) ,  Xp2,  Yp2 |OPp2 J ) , 

path_length ( (Xp2, Yp2 |OPp2 J ,  D2) , 

not (same (D1,D2) ) , 

distance (Xpl, Ypl, Xp2, Yp2,D3) , 

distance (Xc, Yc, Xpl, Ypl, Dcpl) , 

dl stance (Xc, Yc, Xp2, Yp2, Dcp2) , 

distance  (Xb,  Yb,  Xpl,  Ypl,  Dbpl) , 

distance  (Xb,  Yb,  Xp2,  Yp2,  Dbf<2) , 

pi (Fi), 

Cosl  is  (D3A2fDcp2A2-DcplA2)/(2*D3*Dcp2), 
arccos (Cosl, Piover2plusAlpha) , 

A  is  Piover2plusAlpha  -  (Pi/2) , 

Cos 2  is  (D3A2*Dbpl A2-Dbp2A2) / (2*D3*Dbpl) , 
arccos (Cos2, Piover2plusBeta) , 

B  is  Piover2plusBeta  -  (Pi/2) , 

Tc  is  asin(Ce/Ci), 

compute_angle_of_rotaf ion (Xa, Ya, Xb, Yb, RotAngle) , 
calcjbdrv_pt_OvisD (A, B, Tc, Xpl , Ypl ,  Dl , D2, D3,  6, X2bdry, Y2bdry) , 
ra <'  h'lry_pt_Pvi sD  {ft,  R,  Tr,  Xpl,  Ypl,  Dl,  D2,  D3,  Dbpl,  Xibdry,  libury)  , 
abolish  (bdry,  .1) , 

assert (bdry ( [Xlbdry, Ylbdry, X2bdry, Y2bdey, Xpl , Ypl J ) ) , 

invert_bdry, 

rotate2  bdry (RotAnole) , 

bdry ( [xT, VI, X2, Y2 J ) , 

correct_>err&r_in_0|,p_«dge  (Xb,  Yb,  Xc,  Yc,  XI,  Yl, Xlr,  Ylr) , 


assort (initbdry ( (Mab, Ned) ,  (XI r, Ylr, X2f  Y2J) ) ,  ! . 

ploL^Ovis_bdcy ( _ , _ , _ , _ , _ , _ , _ < _ , _ < _ , _ , _ » _ r _ )  *  — 

tell  (user) write  {'  Bdry  does  not  exist. ' ),nl,  !. 

calc_bdryj)t_OvisD (A, B, Tc, Xo, Yo,  Dl, D2, D3,  XI,  X,  Y)  t- 
TcplusA  is  Tc  +  A, 

FX  is  sin  (A)  +  cos (TcpIusA) *sin (Tc) , 

Tl  is  cos  (Tc)  *  (sin  (8) -sin  (Tc)  *cos  {TcpIusA)  )  +  cos (Tc4A+B) *F1, 

T2  is  cos(Tc)  -  sin (TcpIusA) *F1, 

T3  is  cos (TcpIusA) *cos (Tc) *sin (Tc) , 

Dencm  is  cos  (TcpIusA)  *cos  (Tc)  4-cos  (Tc4B)-'cos  (Tc)  -sin  (2*Tc4A4B)  *F1, 
X2  is  (X1*T1  +  D3*T2  4  (D2-D1)  *T3)  /  Denom, 

X  is  Xo  -  (X14X2*sin (Tc) ) , 

Y  is  Yo  -  X2*cos(Tc),  ! . 

calc_bdry_pt_OvisM (A,  B,  Tc,  Xo,  Yo,  Z,  Dl,  02,  D3,  XX, X,  Y) 

Tl  is  sin(A4B)4sin  (Tc)  “cos  (Tc+A+B)  -cos  (Tc)  *sin(Tc) , 

T2  is  D3«  (sin  (A)  »sin(Tc)  *cos(Tc4A>), 

T3  is  D2*cos (Tc) *sin (Tc) , 

T4  is  Z*sin(Tc)  *cos  (Tc) , 

TS  is  cos  (Tc) -cos  (Tc-A-B) +sin  (Tc)  4sin  (A+B)  , 

X2  is  (X1‘T1  +  T2  -  T3  -  T4)/T5; 

X  is  Xo  -  (XI *X2*sin (Tc) ) , 

Y  is  Ya  4  X2*cos (Tc) ,  !. 

/*  If.  edges  ate  connected  then  pt  B  »  pt  C  and  bdry  */ 

/♦  should  start  exactly  at  pt  FI.  */ 

correct_error_in_conn_edges  (Xb,  Yb,Xb,  Yb,  Xpl,l'pl,_,_, Xpl,  Ypl)  . 

/*  If  edges  are  not  connected  use  the  •/ 

/•  bdry  point  as  calculated.  */ 

cor  rect_error_in_conn_edgeji  (_,_,  XI,  Yl,  XI,  Y1 )  . 

/•It  edges  are  part  of  the  opposite  edge,  then  */ 

/*  bdry  should  start  exactly  at  the  opposite  point.  */ 
correct_error_in_opp_edge (Xb, Yb,Xc, Yc,_,_,Xopp, Yopp)  :~ 
opposite_point_minus (Xb, Yb) , 
opposl  te_point_plus  (Xc,  Yc) , 
opposite_point (Xopp, Yopp) . 

/•It  not,  then  leave  start  of  bdry  unchanged.  */ 
correct_error_in_opp_edge  X,  Y,X,  Y)  . 


/ 


plotoebdry  computes  MCA  Interior  Opposite-Edge  Boundaries  (Type  5) 
Assumes  no  shortcutting! 

Updated  12  Jan  69. 


plotoebdry (Ci,Ce, Xa, Ya,Xb, Yb)  :- 

plotoebdry  (Ci,Ce,  Xa,  Ya,  Xb,  Yb,  B)  . 
plotoebdry (Ci,Ce,  Xa, Ya, Xb, Yb, Bdry) 

optimal_path  ( (Xb,  Yt? | _ J  ,D1) , 

optimal_path ( (Xa, Ya |_J , D2) , 
distance  (Xa,  Ya,  Xb,  Yb,  D3) , 

conipute_angle_oX_rotation  (Xb,  Yb,  Xa,  Ya,  KOtAngle) , 
plot2oebdry (Ci,Ce, D1,D2,D3, Xb, Yb, RotAngle, Bdry) , 
/*  tell (user) , write ( (Xa, Ya,Xb, Yb)) , nl, */ 

i 
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plot2oebdry  (IntCost, ExtCost, Dl, D2,  D3,  Vx,  Vy, Anglo, RevBdry)  s- 
initralize_for5, 
tell  (user) ,  nl,nl, 

/*  «rite(' I1CA  Int  Opp-Edge  (Type  5)  Wry  being  plotted  for  edge  */ 

Tc  is  asin (ExtCost/IntCost) ,  9  ''  ' 

calc_oebdry_pts (Tc,  Dl, D2,  D3, V*,  Vy,  Angle) , 

rotate_bdry (Angle) , 

retract (bdry  (Bdry) ) , 

remove_last_pt (Bdry, RevBdry) , 

truncate_of f_map (RevBdry,  FinalBdry) , 

assert (initbdry (oe, FinalBdry) ) , 

/*  tell  (bdry_out),  write  ('  Type  5 

write_to_bdry_file (bdry, RevBdry) , 
output_to_£igure_£ile,  */ 


calc_oebdry_Pts (Tc, Dl , D2, D3, Vs, Vy , Angle)  : - 
Xll  is  (D34D2-D1) /2, 

X22  is  XU/sin  (Tc) , 

Xa  ia  Vx  +  XU, 

Ya  ia  Vy, 

Xb  ia  Vx  +  X22*sin (Tc) , 

Yb  is  Vy  -t  X22*cos (Tc) , 

assert (bdry ( (Xa, Ya, Xb, Yb, Vx, Vy ) ) ) ,  | . 

initialize  for5 

abolish (bdry, 1) ,  |, 


/*  First  check  whether  bdry  starts  on  the  map. 

/*  if  not.  call  trunc. .3  */ 
truncate_of f_map { [XI, Yl, X, Y | B] , 82) 
mi.nX  (MinX)  ,minY  (MinY)  , 
maxX  (MaxX)  ,maxY  (MaxY) , 

DelX  is  MaxX  -  MinX, 

XI  >  MinX,  XI  <  MaxX,  Yl  >  MinY,  Yl  <  MaxY, 
truncate_o£f_map2 ( (XI, Yl, X, YjB) , B2) ,  ! . 
truncate_o£f_map ( (XI, Yl, X, Y | b] , B2)  : - 

truncate_of f_map3 ( (XI, Yl, X, Y| B J , B2) ,  ! . 
truncate_of£_map2 ( [XI, Yl, x, Y| B] , (X1,Y1|B2)) 
minX (MinX) .rninY (MinY) , 
maxX (MaxX) ,maxY (MaxY) , 

DelX  is  MaxX  -  MinX, 

»JinX2  is  MinX  -  0.1*DelX, 

MinY2  ia  MinY  -  0.1*DelX, 

MaxX2  ia  MaxX  +  9.1‘DelX, 

MaxY2  ia  MaxY  1  0.1‘DelX, 

X  >  MinX2,  X  <  h'axX2..  Y  >  MinY2,  Y  <  MaxY2, 

ttoncate_o££_map2({X,Y|BJ,B2),  !. 
truncate_o££_map2(lXl,Yl,X,Y|BJ,  (X1,Y1,X,YJ) 
truncate_off_map2((x,Y|,  (X.YJ)  !. 
truncate„of£_map3([Xl,Yl,X,YJ, (X1,Y1,X,YJ) . 

/* 

truncate  _off_map3  ( (XJ,  Yl,  X,  Y/BJ ,  B2) 

truncote_o££_map ( (X,  Y |BJ , B2) ,  J . 


IC  so,  call  trunc.. 2  */ 


/*  starts  Oil  the  map.*/ 

/»  starts  orr  the  map.*/ 

/*  Assumes  that  Bdry  */ 
/*  starts  OH  the  map.*/ 


1 . 

/*  Bdry  is  entirely  off  the  map 
except  perhaps  for  the  last  pt. 
/*  Bdry  starts  off  the  map.*/ 


as3ert_3hortcutMf lag (Xv,  Yv, Xv,  Yv) . 
assert_shortcut“flag  ,’Xv,  Yv,  Xpl,  Ypl) 

assert  (shortcut (Xv, Yv,Xpl,  Ypl) ) ,  ! . 


Clockwise ( (XI, Yl, c(C) ,Xi, Yi|OPJ ) 
reaion_eliot  (P.) , 

g»t_XY?w_edoc  (XI ,  Yl ,  R,  (Xa,  Ya,  Xb,  Yb}) , 
on_ray(Xi,Yi,Xl,Yl,xb,  Yb) ,  I  . 
counterclockwise ( (XI , Yl ,  c (C) , Xi, Yi | OP] ) 
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region_cli at (R; , 

get_XYccw__edge  (XI, «,  Rf  (Xa, Ya,  Xb,  YbJ ) , 
un_ray(Xi,Yi,Xl,Yl,Xa,Ya),  !, 

get_XYcw_edge(Xl,Y3,  [Xa,Ya,  ,  ,Xb,Yb|RJ,  [Xa,Ya,Xb, YbJ) 
on_ray  (XI ,  Y1 ,  Xb,  Yb,  Xa, Ya) ,  • . 
get_XYcw_edge(Xl,Yl, [Xa,Ya,_,  ,xb, Yb|P.;,Edge) 
get_XYcw_edge (XI, Yl7R7Edge) ,  ! . 

get_XYccw_edge(Xl,Yl, [Xa,ya,  ,  ,Xb,Yb|RJ,  [Xa,Ya,Xb, YbJ) 
on  ray  (XI,  Yl,  Xa,  Ya,  Xb,  Yb) ,  !, 
get_XYccw_edge(Xl,Yl, (Xa,Ya,  ,  ,Xb, YbiRJ.Edge) 
9*t_XYccw_edge (XI, Yl, R,  Edge) ,  !. 
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/A4AAAAAAAAAAA4AAAAAA4AAAAAA44AAAAAAAAA******************* *********** 


# 

*  rile  Hboundary_join"  or  "bj" 

4 

*  Updated  30  Jan  89 

* 

*  "bdry_join"  truncates  boundaries  and  joins  them  together  into 

*  a  network  of  the  active  boundaries  inside  a  homo'  'sneous-cost  region. 

* 


/*»•»»»«•«»••**»***•»*  Top-level  predicate  *»*****»*»»»*«»*»*»♦***»/ 


bdty_join 

initialize/ 

first_level_bdrys (Al) ,  % 

assert (old_bdry_set ( t ! ) ) / 
assert (current_bdry_set (Al) ) , 

retract (current_bdry_set (Acur) ) ,  /*  start  of  while-not-done  loop  n/ 

retract_cut (old_bdry_set (Aold) ) , 

not  (same_set  (Acur,  Aold) ) , 

assert (o!d_bdry_set (Acur) ) , 

next_leveljbdrys (Acur , Anew) , 

assert (current_bdry_aet (Anew) )  , 

done (Anew),  /*  end  of  while-nct-done  loop  */ 

get_£inal_bdrys (Afinal) , 
output (Afinal) , 
cleanup,  halt,  ! . 
bdry_join  :- 

tell (user),  nl,nl, 

write  ('  Checking  for  center  shortcutting' > .nl,nl, 
ellm_incon>plete_tcees, 
get_finaljbdrys (Afinal) , 
bdry_edge_intersections (Afinal, BED , 
f ind_exact_opposite_pt (BEI, P) , 
recurse_unless_done (P) , 
output (Afinal) , 
cleanup,  halt,  ! , 
bdry_join  : - 

tell  (user)  ,  nl,nl, 

write  ('  ERROR  in  "  bdry-join' '  :  doesn"t  converge' ),  nl,  nl,  !-. 


Second-level  predicates  ***»»*******»*»***»»/ 

y««»t*M4A**MM*«*M«M*t*MM*»*M«**M**f»»»«ii»***»»*M***»«»**M*^ 

initialize  : - 

tell (user) , 

nl,nl,  write (' Boundaries  being  joined:'),  nl,nl, 
a boil *h 1} r 
assert  (ctr  (1) ) . 

fi rst_level_bdryo (A2)  :- 

number_of_edge3  {!•) , 
index_list_/toJ  ( 1 ,  l»,  IndexListO) , 
cons  (IndexListO,  ((1,2)),  IridexList) , 
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assert (indices (IndexList) ) , 
£irst_level_bdrysl (A1,N) , 
order_indices (Al, A2) ,  !. 

next_level_bdrys (Al,  A3) 
reset (A1,A2) , 

propogate_next_level_bdrys (A2) , 
get_active_bdry_set (A3) ,  I. 


done (A) 

one_bdry_tree (A) , 
tell (user) ,  nl, nl, nl, 

write  to  screen ('  DOME  -  single  bdry-tree' ) , nl, nl, nl,  !. 

get_final_bdrys (A) 

get_tbdrys (A) ,  ! . 

bdry  edge_intersectiono CIJ , l 1) • 

bdry~edge_£nter sect lens ( H  1 1, J) , B, LPt) I L] , ( ( (1, J) , E, LPt ] | BEI) ) 
edge_bdry_intersection(K, (I, J) , LPt) , 
bdry_edge_intersections (L,  BED  ,  ! . 
bdry_erfge_intersections ( ( (( X, JJ ,  8, EPt ) |L),BEI) 
bdry_edge_intersections (L, BEI) ,  !. 


elim  incomplete  trees 

tree(ll7jl,I*,R), 

not  (complete._tree  (tree  ( ( I ,  <J ) ,  L,  R) ) ) , 
eliminate  tree  tbdrys  (tree  ( (I,  J) ,  L,  R) ) , 
fail,  ! . 

elim_incomplete_trces  s-  !. 

£ind_exact_opposlr,'j_pt  (BEX,  p) 

find_exact_opposite_ptl (BEI) , 
opposite_edge (OE) , 
new_opp_pt  (OE,  OE,  P) ,  ! . 

find  exact_oppositc  ptl(U). 

find7exact_opposit«._ptl(ini,aj,B,  (LX,I.YJJ  |BEI)  > 
optimal  path ((LX, LY, c (C) , X2, Y2 IOP j ) , 
update_opp edge  (I ,  J,  ( LX,  LY, c  (C) ,  X2,  Y2  |OP ) ) , 

£ind_exact_opposite_ptl (BEI) ,  ! . 

recurse_unless_don" ( (Xopp2, Yopp2 J ) 
not  (£irst_  pass_done) , 
opposite^point (Xoppl,  Yoppl) , 
not (same ( (Xoppl, Yoppl J , (Xopp2, Yopp2) ) ) , 
retract (opposite_point (Xoppl, Yoppl) ) , 
assert (opposite_polnt (Xopp2, Yopp2) ) , 
assert  (££r3t_pass__done) , 
cleanup2, 
bg2,  ! . 

recurse_unless_done ( [Xopp2, Yopp2 J ) 
tell  (user) ,  nl,  nl,  nl, 

write_to_screen ('  DONE  -  finished  Second  Pass' ),  nl,  nl,  nl,  !. 

output  (A) 

write_heading, 

write_bdrys_to_£ile (hca  opm, A) ,  nl,  !. 


cleanup 

abolish  (ctr,  1) , 

abolish (tbdry, 5) , 

ahc)  isli  (current_bdi  y_set,  1) , 

abolish (bdry_list, ij , 
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abolish (bdry_intersection, 5) , 
abolish (initbdry, 2) , 
abolish (tree/ 3) , 
tell  (user) , 
nl,  nl, 

write  ('Boundary  generation  complete:  results  in  file  "hca_opm"'), 
nl,  nl,  ! . 

cleanup2 

abolish (ctr, 1) , 
abolish (tbdry, 5) , 
abolish (currenc_bdry_set, 1) , 
abolish (bdry_list, 1) , 
abolish (initbdry, 2) , 
abolish (region_eli3t, 1) , 
abolish  (pseudo__optimal_path,  1) , 
abolish (tree, 3) , 
tell  (user) , 

nl,nl, write ('Pass  Two  beginning' ), nl, nl,  !. 


/**********A*A**»A4********#*********Ai'************  ;»  **************  *  A*  J 

/*•*«***»***«  “inltialisatin"  subordinate  predicates  *»**•******<.*/ 

/»*'***  ***********'>*“****  **..***.***4*.  .*.*».»****»**»**.: *****  ******/ 

/*  Assert  the  points  at  which  bdcys  are  'anchored'  to  the  region  edges  */ 
assert_anchors 

number_of_edges  (M) , 
index_liat_J toJ  (1,  W,  IndexListl) , 
asse»:t_anchors  (Indextist) ,  !. 
assert_anchors ( I) )  !. 

assert  anchors (( [I,J] | L J ) 

”  ini tbdry ( *  I, J] , (X,Y|BJ), 
assert  (anchor  (X,  Y) ) , 
assert_anchors  (I,) ,  !  . 

reset  (A,  Al) 

abolish (tbdry, 5) , 
abolish (edge_int_pt, 3) , 
ordar_indices (A, Al) , 
reassert_tbdrys (old, Al, 1) , 
abolish  (ctr,  1) , 
assert (ctr (1) ) , ! . 


. . . . *♦ . ***** . ***•/ 

/**•**•*-***  "first-1  jvel-bdrys"  subordinate  predicates  *•••*•*••**•/ 
/ . ****** . * . ******** . . . »••********/ 


£lrst_le*/el_bdrysl  (A,  N) 

retract (indices (IndexList) ) , 

truncate_lst_le.'cl_bdrys  (IndexList,  H) , 

retract_all_and_rtn_shorteot_tbdrys (ShortBdrys) , 

matching_pairs (ShortBdrys, PairedBdrys) , 

bdry_edge_intersections (ShortBdrys, EdgelntBdrys) , 

set , subtraction (EdgelntBdrys, PairedBdrys, EdgeIntBdrys2) , 

cons (EdgeIntBdrys2, PairedBdrys, ActiveBdrys) , 

reassert  tbdrys  fold, Ant  j  veBdrys, 1) , 

llminusl  Is  II  -  1, 

not  (list_lenotn  (ActiveBdrys,  llminusl) ) , 
not (list_length (ActiveBdrys, H) ) , 
index_list (ActiveBdrys, Indexbl) , 
set_subtroction (indexList, lndexbl, lndexL2) , 

/*  complcment^indcj^list  (II,  Indcxtl,  lndoxL2) ,  */ 
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not (same_set (IndexList, IndexL2) ) ,  /*  If  same,  no  new  bdry  pairs  */ 

assert  (indices  (lnder.L2j ) , 

£irst_level_bdrysl (A,N) ,  !. 

£irst_level_bdrysl (A,N) 

assert_singles (1,H) , 
get_tbdrys (A) ,  ! . 

match ing_pairs ( [FiratBI Rest J , RevRest) 

matching_pairsl  ( [FirstBI Rest J ,  FirstB,  P.evRest) ,  ! . 

matching_pairsl ( | ) ,_, J) )  !. 

matching_pairsl  ( ( [IDlast,  Blast,  LPtfirst]  J,  (IDfirst,  Bfirst,  LPt first) , 

( (IDlast, Blast, LPtfirst] ,( IDfirst, Brirst, LPtfirst] ) )  1. 

matching_pairsl ( ( (IDlast, Blast, LPt last] ] , [IDfirst, Bfirst, LPtfirst J ,  ( ] )  ! . 

matchingpairsl <| [ IDl, Bl, LPtl] , [ID2, B2, LPtl) | Rest J , Bfirst, 

( (101, Bl, LPtl J , (ID2, B2, LPt 1 } | RevRest) ) 
matching_pairsl (Rest, Bfirst, RevRest) ,  ! . 
matching_pairsl ( [Bl, B2 | Rest ] , Bfirst, RevRest) 

matching_paixsl ( (B2 [Rest ] , Bfirst, RevRest) ,  ! . 

troncate_lst_level_bdrys  ( [  (_,_]  ],fl)  !.  /*  Base  case  */ 

truncate_lst_level_bdrys  ( [  (II,  1] ,  (1, 2)  ]  ,11)  /*  Last  pair  of  bdrys:  */ 

initbdry ( ( 1 , H) , [XI, 11 |B1] ) ,  /*  succeeds  if  they  intersect.  */ 

initbdry  ([1,2],  [X2,Y2|B2]), 

bdry_inter sect ion ( [XI, Y1 [Bl] , [X2, Y2 |B2] , IntPt, Bltrunc, B2trunc) , 

get_counter_and_increment (CO) , 

get_counter_and_increment (Cl ) , 

assert  (tbdry  (new,  CO,  (H,  1] ,  Bltrunc,  IntPt) ) , 

assert (tbdry (new, Cl, [1,2], B2trunc, IntPt) ) , 

region_elist (R) , 

truncate_bdry_and_edges  ( (1, M] ,  [XI,  Y1  ] Bl. ) ,  R) , 
truncate_lst_level_bdrys ([(_,_] },M) ,  ! . 
truncatc_lst_level_bdrys  < [ [Nminusl, MJ , [H, 1 ] I  Rest) , N) 

Nminusl  is  H-l,  /*  Mext  to  Last  pair  of  bdrys:  */ 

initbdry ( (Nminusl, NJ , [X1,Y1|B1]),  /*  succeeds  if  they  intersect.  */ 

initbdry ([1,NJ,  [X2,«|B2]), 

bdry_intersection  ([X1,Y1|B1],  [X2,Y2|B2],  IntPt,  Bltrunc,  B2trur«c) , 
get_counter_ai:d_increment  (CO) , 
get_counter_and_increment (Cl ) , 

assert  (tbdry  (new, CO,  (Nminusl,  II] ,  Bltrunc,  IntPt) ) , 
assert (tbdry (new, Cl, [N, 1 J , B2trunc, IntPt) ) , 
region_elist (R) , 

truncate_bdry_and_edges  < [N, Nminusl J , [XI , Y1 1 81 ) ,  R) , 
truncate_lst_level_bdrys  ( ( [II,  1]  |Rest) ,  N) ,  ! . 
truncate_lst_level_bdrys([ [1,0], [0,KJ |Rest),N)  /*  Succeeds  if  bdrys  are*/ 
initbdry ([1,0], (XI, Y1IB1J),  /*  adjacent  and  intersect*/ 

initbdry ([J,K], [X2,Y2|B2]), 

bdry_inter sect ion ( [XI, Xl 1 81 ) , [X2,  Y2 | E2 J , IntPt,  Bltrunc,  B2trunc) , 

get_counter_and_increment (CO) , 

get_counter_and_increiaent  (Cl ) , 

assert  (tbdry  (new,C0,  [I,  J],  Bltrunc,  IntPt) ) , 

assert (tbdry (new, Cl, ( J, K] , B2trunc, IntPt) ) , 

region_elist (R) , 

truncate_bdry_and_edges ( [I, J] ,  [X1,Y1|B1),R), 
truncate_lst_level_bdry3 ( ( (J, KJ  j  Rest J ,  N) ,  1 . 
truncate_lst_level_bdrys ( [Tl, J], !K,LJ |Rest),N) 

ordered (1, J, 11, 01) ,  /*  Recurses  if  previous  */ 

initbdry ( f 11,0) J , (XI, Y1 IB1J ) ,  /*  adjacent  and  intersect*/ 

region_elist(R) ,  /*  rules  have  failed.  */ 

truncate_bdry_and_edges ((11,01), [X1,Y1|B1),R), 
truncate_lst_lcvel_bdrys  ( [  [K,  L]  I  Rest ) ,  (I) ,  ! . 

/*  Asserts  a  temp  tbdry  which  stops  at  the  region  edge  if  initbdry (1,0)  */ 

/*  intersects  a  region  opposite  edge.  Always  succeeds.  Also  asserts  */ 
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/*  ' edge_bdry_inhe r sect ion (K,  (1,0),  [X, Y])'  for  each  intersection  point.  */ 
truncate_bdry_and_edges  ( ( I,  JJ ,  (X,  Y|B],  [XI, Yl, h  (Q) ,  K,  X2,  Y2 1 RJ ) 
not  (bdry_starts_at_edge  (I,  J,  K) ) , 

bdry_intersection  UX,  Y I B J . [XI, Yl, X2,  Y2} , IntPt, Btrunc, Bltrunc) , 
get_counter_and_increment (CO) , 
assert (edge_bdry_intei section (K, [ 1,0),  IntPt) ) , 
assert (tbdry  (temp,  CO, (1, J) , Btrunc, IntPt) ) ,  ! . 
truncate_bdry_and_edges ( [I, J] , [X,Y|B],  [XI, YI,  ,K,X2,Y2|RJ) 
truiicate_bdry_eiid_edges((l,0),  (X,  Y[B)7r),  !. 
truncate_bdry_and_edges ( { I, J), [X,Y|B], (J)  !. 

assert_singles (I,N)  /*  if  any  vertex's  lst-Ievei  bdry  */ 

Iplusl  is  I  +  I,  /*  has  not  yet  been  generated,  do  */ 

Iplusl  <  N,  /*  ao  now.  */ 

tbdry  (I,  Iplusl) ,_  ,_) , 

assert_singles (Iplusl,N) ,  ?. 
assert_singles (I,H) 

Iplusl  is  I  +  1, 

Iplusl  <  M, 

not  (tbdry  [I,  Iplusl ),_,_)), 

initbdry((I, Iplusl], B) , 
get__counter_and_incremont  (Ctr) , 
assert (tbdry (new, Ctr, [ I, Iplusl) , B, [))), 
assert_singles (Iplusl, H) ,  !. 
assert_singles (I,H) 

Iplusl  is  I  +  1, 

Iplusl  «  N, 

tbdry  (_,_,  IN,  1J  ,_,_) ,  !. 

assert_singles (I,N) 

Iplusl  is  I  +  1, 

Iplusl  -  N, 

not  (tbdry  [M,1J,  ,  )), 
initbdry((l,H],B) , 

assert  (tbdry  (new,  ctr,  («,  1 J ,  B,  ( J ) ) ,  f . 


/*••••***•*•••  “next-level-bdrys"  subordinate  predicates.  *»*■*•♦»»«*/ 
. . ************** . ***** . ******* . *»***/ 


/*  Previously  connected  at  end  */ 
/*  Hot  same  bdry  */ 


/* 

/* 


Hot  previously  asserted  */ 
Use  indices  in  order  */ 


propogate_next_level_bdrys ( ( ] )  s-  !. 
propogate_next_levelJbdrvs([ ( (I,  0),B1, (LX,LYJJ|AJ) 
tbdry (_,_,  (K,LJ,B2,  (LX.LYJ), 
ad  jacent_bdrys  (I,  0,  K,  L,  11,01,  K1,L1)  , 
not (same (II, LI) ) , 

ordered (II, LI, 12, L2) , 
not (tbdry (_,_, ( 12, L2 J , (LX, LY |_J ,  )), 
ordered  (11,01, 13, 03) , 
ini tbdry (( 13,03) , B1 Full) , 
ordered (II, LI, 14, L4) , 
ini tbdry ((I4,L4J,B12), 

bdryintersection (Birull, B12, (IntX, intY) ,_, B12trunc) , 
wlthin_tolerance (LX, LY, IntX, IntY) , 

get_correct_half_of_bdry;BI,B2fB12, (LX,  LY) , B12trunc, (X12,YI2|B12corJ) , 
get_iast_pt ( [X12, Y12|B12cor J ,  B12Xlast,  B12Ylast) , 
get_counter_and_increment (Cl) , 

assert (tbdry (new, Cl, JI2, L2 J , [LX, LY | B12cor] , ( Bl2Xlast, B12YlaatJ  J ) , 
propogate_next_level_bdrys (A) ,  !. 

prorogate _next_levelJjdry»(UlI,dJ,B,LFt)|AJ)  /‘  Disregard  bdry  which  is 
propogate_next_level_bdrys (A) ,  I.  I*  paired  with  another  bdry  or 

t*  intersects  a  region  edge. 

propogatc_ncxt_level_bdryo ( ( ( [1, 0) , Bl, | ] ] I A J )  /*  Disregard  single  bdry 

propogate_next_levei_bdrys (A) ,  !. 


*/ 

*/ 

V 

*/ 
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get_correctjialf_of_bdry ((XI, Yl |B1), [X2, Y2|B2), IX12,Y12|B12] , 

(Xi, YiJ,B12tr, (Xi,Yi|B12coxrJ)  /*  Intersect  a  line  from  B1  */ 

Xltest  is  Xi4 ( (Xl-Xi} /20) ,  /*  to  B2  drawn  just  inside  their  pt  of*/ 

Yltest  is  Yi+ ( (Yl-Yi) /20) ,  /*  intersection,  with  the  new  bdry.  */ 

X2test  is  Xi+ ( (X2~Xi) /20) ,  /*  If  no  inters,  bdry  is  outside  Bt  */ 

Y2test  is  Yi+ { (Y2-Yi) /20) ,  /*  and  B2,  so  this  is  correct  half.  */ 

not (bdry_intersectioo_exact ( (Xltest, Yl test, X2test, Y2test] , B12tr,  _,_,_) ) , 
reverse_path_list (B12tr, (_,_|B12corr) ) ,  !.  /*  but  reversed.  */ 

get_correct_half_of_bdry (Bl,_, B12, 

(Xi,Yi),_,  [X.i,Yi|B12otherhalf])  /*  Otherwise  get  the  other  */ 

reverse_path_list (B12, B12Rev) ,  /*  half  of  new  bdry.  */ 

bdry_intersection (Bl,  B12Rev,_,_, B12trunc) , 
reverse_path_list (B12trunc, (_,_|B12otherhalf J ) ,  t. 

get  active_bdry  set (  ) 

tbdry  (new,_,Jl, J) , Bl, LFtl) , 

intersect_with  candidate  bdrys(I,  J,  Bl,LFtl), 
fail,  ! . 

get_active_bdry_set (A) 

retract_all_and_rtn_shortest_tbdrys (ShortBdrys) , 
while_changing_reassert_tbdrys  (ShortBdrys, , 
reset_last_pts, 
get_tbdrys (A) ,  ! . 

intersect  with_candidate  bdrys (I, J, (XI, Y1 | Bl J , LPtl) 
get_tbdryIJorJI (r,_, (I, K) , B2, LPt2) , 

not (same (F, temp) ) ,  /*  not  a  temporary  bdry  */ 

not (same ( |X1, Yl] , LPt2) ) ,  /»  not  a  child  of  Bl  «/ 

ordered (I, J, II, Jl) , 
ordered  (1,K,  I2.K2), 

not  (same  ( (Il,<71),  (I2.K2) ) )  ,  /*  not  the  same  as  Bl  */ 

interior_intersection ( (XI, Yl | Bl J , LPtl, B2, LPt2, IntPt, Bltrunc, B2trunc) , 
not  (asserted_tbdry  ( (12,  K2] ,  IritPt) ) ,  /*I£  Bl  intersects*/ 
get_counter_and_increment (CO) ,  /*  the  candidate,  then  */ 

assert (tbdry (temp, CO, (12, K2J,B2trunc, IntPt)),  /*  assert  both  as  temps  */ 

not  (asserted_tbdry( (II, Jlj , IntPt) ) ,  /*tf  not  asserted  */ 
get_counter_and_increment (Cl) , 
assert (tbdry (temp, Cl,  (II, Jl J , Bltrunc, IntPt) ) , 
fail,  ! . 

intersect  with_candidate  bdrys (I, J, (Xl,Yl|Bl),LPtl) 
get_tbdryIdorJI (?,_, { J, LJ , B2, LPt2) , 

not (same (r, temp) ) ,  /*  not  a  temporary  bdry  */ 

not (same ( [XI, Yl) , LPt2) ) ,  /*  not  a  child  of  Bl  */ 

ordered (I, J, II, Jl), 
ordered  (J,  L,  J2,  L2> , 

not (same ( (I 1, 01] , (J2, L2) )) ,  /*  not  the  same  as  Bl  ♦/ 

interior_inter section ( (XI, Yl | Bl ] , LPtl, B2, LPt2, IntPt, Bltrunc,  B2trunc) , 
not (asserted_tbdry ( (J2, L2) , IntPt) ) ,  /*If  Bl  intersects*/ 
get_counter_and_increment  (CO) ,  /"*  the  candidate,  then  */ 

assert (tbdry (temp, CO,  |J2, L2] , B2trunc, IntFt) ) ,  /*  assert  both  as  temps  */ 

not (3oaerted_tbdry ( (II , Jl) , IntPt) ) ,  /*  if  not  asserted*/ 

get_counter_und_increment (Cl) , 
assert (tbdry (temp, Cl,  ( 1 1 , Jl J , Bltrunc, IntPt) ) , 
fail,  ! . 

intersect_with_candidate_bdrys  (1,  J,  (XI,  Yl  1 132  ) ,  LPtl)  i-  /*  Intersect  bdry  with  */ 
region_eJist (R) ,  /*  region  edges.  */ 

tiuucate_bdry_and_edges ( ( I, J] , (XI, Yl I Bl ) ,  R) ,  !, 

asserted  tbdry ( (I, Jj , LI’t)  /*  tbdry  is  already  asserted  */ 

tbdry  (_,_,  1 1,  J) ,_,  LPt) ,  !. 

asserted_tbdry  ( ( I,  Jj ,  [Xil,  Yil  J )  /*  tbdry  with  appy.-*  last  pt  */ 

tbdry I I, J) ,_, (Xi2, Yi2J ) ,  /*  is  already  asserted  */ 

within_tolerancc(Xil,Yil,Xi2,Y12) ,  I . 
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retract_all_and_rtn_3hortest_fcbdrys ( 1 t (I, J] , BminD, LPtminD] I  Rest) ) 

tbdry (_,_, [I, J] , (X, Y|B) ,_) ,  /*  Retract  all  IJ  bdrys  */ 

retract_l J_bdrys (I, J, Bdrys) , 
get_shortest_tbdry (Bdrys, _, BminD, LPtminD) , 
retract_all_and_rtn_3l)ortest_tbdrys  (Rest) ,  ! . 
retract_all_and_rtn_shorte3t_tbdrys ( ( ) )  S . 


retract  IJ  bdrys (I, J, ( ( (X, Y | B) , LPt] I Bdrys) ) 

“retract  (tbdry  (_,_,  1 1,  J) ,  (X,  Y I B) ,  LPt) ) , 
retract_IJ_bdrys (I, J, Bdrys) . 
retract  IJ  bdrys  (_,_,() )  !. 

xretract  IJJsdrys (l7j,X, Y, ( t (X,Y|B),LPt) IBdrysJ) 
retract (tbdry (_,_, |1, J), (X, Y I B J , LPt) ) , 
retract_IJ_bdrys (I, J,X,Y,  Bdrys) . 
xretract_IJ_bdrys IJ)  !. 


/*  Retract  all  bdrys  with  */ 

/*  index  I,J,  and  return  */ 

/*  them  in  a  list  */ 

/*  Retract  all  bdrys  */ 

/*  with  index  1,0  which  */ 
/*  have  same  starting  pt  */ 
/*  £  rtn  them  in  a  list  */ 


get_shortest_tbdry ((), 100000, !. 
get_shortest_tbdry ( l IB, LPt) IBdrysJ , HewMinD, HewB, NewLPt) 
path_lengtli  (B,  D) , 

get_shortest_tbdry (Bdrys, MinD, BminD, LPtminD) , 

get_minD_and_B  (D,  B,  LPt, MinD,  BminD,  LPtminD,  He  wMinb,NettB,  Hewl.pt) ,  !  . 
get_minD_and_B (D, B, LPtB, MinD, BminD, LPtminD, D, 6, LPtB)  D  <  MinD,  !. 
get_minD_and_B (D, B, LPtB, MinD, BminD, LPtminD, MinD, BminD, LPtminD)  s-  I . 


whil«_changing_reassert_tbdrys (Setl, Ct rl, Set2, Ctr2)  s - 
reasserfc_connected_tbdrys (Setl, Ctrl, Set2,Chr2) , 
not  (same__set  (Setl,S'-t2) ) , 

while_clianging_reassert_tbdrys  (Set2,Ctr2,_,_) ,  ! . 
vhile_changing_reassert_tbdrys (Setl, Ctrl, Set2,Ctr2) 
same_set (Setl, Set2) ,  !. 

while_changing_reassert_tbdrys (Setl, Ctrl, Set2, Ctr2)  : - 

write_to_screen ('Error  in  -reassert_tbdrys-  ' ),nl, !. 


reasscrt_connected_tbdrys ( 1 ) ,Ctr, ( J ,Ctr)  !. 

reassert_connected_tbdrys  ( [  ([I,  J] ,  B,  LPt)  I  ActSet  J ,  Ctr,  XnteriorBs,Ctr2) 
connected_to_an_anchor ( ( I, J J , B) , 
ordered  (I,  J,  K,  L) , 

assert (tbdry (old, Ctr, (I, J] , B, LPt) ) , 

Cplusl  is  Ctril, 

reassert_connected_tbdrys (ActSet, Cplusl, XnteriorBs,Ctr2) . 
reassert_connicted_tbdrys ( ( ( ( I,  J] ,  B, LPt) I ActSet ], Ctr, 

(  ( |I,  J) ,  B,  LPt)  I  InteriorBs] ,  Ctr2)  s- 

reassert_connected_tbdrys (ActSet, Ctr, InteriorBs,  Ctr2) . 


connected_to_an_anchor ( | X , J J , B0)  :  - 
ad  jacent_edges  (I,  <J) ,  I. 
connected  to_an  anchor (( I, JJ , (XI, Y1 | BJ ) 
tbdry  (K,L),B2,  |X1,YJ|), 

connected_to_an_anchor ( IK, L) , B2) ,  ! . 
connected  to  aii  anchor  ( (I, <JJ ,  (XI, Y1  |B) ) 
tbdry (_7_, I K, L) , (XI, Y1 I B2) ,_ ) , 

connectcd_to_an—anchor ( (K, L) , B2) ,  I . 


/*  Bdry  starts  at  a  region  edge  */ 

/*  Bdry  starts  at  last  pt  of  */ 

/*  another  anchored  bdry.  */ 

/*  Bdry  starts  at  first  pt  of  */ 

/*  another  anchored  bdry.  */ 


/**«* . *******  "dene"  subordinate  predicates 

/*  Example  'tree'  fact  (indented  for  clarity  only  -  root  is  at  left): 
tree  (P,  7),  tree((7,3J,  trcc((7,2),  tree  (|7, 1 1, '()','()') , 
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tree  (13,7) 


tree  ([1,2],'  l]','  II*)}, 
tree ([2, 3] , '()'#'  []'))» 

,  tree (13, 4],' [  J ' , '  [  ]' ) , 

tree (14,7),  tree  ( (4,  5],'  [)','[]'), 

tree { 15,  7 J, tree (15, 6|,'  [)','  []'), 

tree ( (6, 7 J , ' ( ) ' , ' ()'))))) . 


17, 

/ 

/ 

17,  3) 

/  \ 

(7,  2  J  [2,3] 

/  \ 

[7,1]  [1,2] 


\ 

\ 

[3,7] 

/  \ 

[3,4]  [4,7] 

/  \ 

14,5]  15,7] 

/  \ 

[5,6]  [6,7] 


*/ 


one__bdry_tree  ( [  [  (I,  J],B,LPt)  |A]) 
abolish (tree, 3) , 
numb-er_of_edges  (tl) , 
assert_lea£_trees (1,N) , 
vhile_changing_combine_trees (N) , 
number  of_trees (NT) , 

NT  —  T,  !  . 

while__changing_combine_trees  (N) 

abolish (number_o£_trees,  1) , 
assert (number_o£_trees (N) ) , 
retract  (number__of_trees  (PrevHT) ) , 
combine_trees  (1,11,  NT) , 
assert (number_of_trees (NT) ) , 

PrevNT  NT,  ! .  /*  fails  here  until  no  longer  changing  */ 

combine_trees(X,N, NumTrees) 

I  <  N, 

tree < [ I, J] , Leftl, Rightl) , 

tree ( [ J, K] , Left2, Right2) , 

not (same  (X,  K) ) , 

succeed_if_ joined (I, J, K) , 

retract (tree ( (X, J] , Left 1, Rightl ) ) , 

retract  (tree  ( [  J,  K]  , Left2,  Right 2) ) , 

assert  (tree  ( [  I,  K] ,  tree  ((l,Jj, Leftl,  Rightl) ,  tree  ( [  J,  KJ ,  Left2,  Right  2) ) ) , 
Iplusl  is  I  4  1, 

combine_trees  (Ipl usl ,  II,  NumTrees) ,  I . 

combine_trees  (I,  N,  NumTrees)  /*  rinal  case,  where  tree  ( 1 1, <JJ , , )  */ 

tree  ( (X,J) ,  Leftl,  Rightl) ,  /*  is  combined  witli  tree  ( (J,  IJ , , )  */ 

tree ( [ J, I ] , Lef t2, Right2) , 
not  (same  (Leftl,  Le£t2) ) , 

succeed_if_ joined (I,J, I) ,  /*  TEMP:  always  succeeds.  Won't  always  */ 

retract (tree ( |I, J] , Leftl, Rightl) ) ,  /*  succeed  for  center-o/c  */ 

retract (tree ( [ J, I] , Le£t2, Right 2) ) , 

assert (tree ([1,1], tree ( [ I,JJ , Leftl, Rightl) , tree ( [ J, I ] , Le£t2, Right2) ) ) , 
count  trees (NumTrees) .  !. 

Lost  iter,  of  while-changing  loop,  */ 
where  single  tree  is  tree  ( 1 1, 1 ) , . . )  */ 


ns_trees (H,H, NumTrees) 

tree  ( (N,  J] ,  Leftl,  Rigtitl) , 
tree ( [ J, K) , Le£t2, Right2) , 
not  (same  (tl,  K) ) , 


combine  trees  (I,N, 1)  /♦ 

tree([lfl], Leftl, Rightl),  !.  /* 

combine  trees  (I, II,  NumTrees) 

~1  <  II, 

Iplusl  is  I  4  1, 

combi oe_trec=  (Iplusl, ",  NumTrees) , 
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aucceed_if_ joined  (M,  J,  K) , 
retract  (tree  ( (H,  01 ,  feftl,  Rightl) ) , 
retract  (tree  ( (<J,  KJ ,  Left2,  Right2) ) , 

assert  (tree  ( [H,  K) ,  tree  ( (M,  JJ ,  beftl,  Rightl) ,  tree  ( (J,  KJ  ,Left2,  Right2) ) ) , 
count_trees  (MuinTrees) ,  1 . 

combine_trees (H,H,  MumTrees)  /*  Base  case  for  all  but  last  Iteration  */ 

count_trees  (MumTrees) ,  !  . 

count_trccs  (MuinTrees) 

abolish (count , 1 ) , 
assert (count (0) ) , 
tree  (_,_,_) , 
retract_cut  (count  (C) ) , 

MuinTrees  is  C  4  1, 
assert (count (MumTrees) ) , 
fail,  ! . 

count_trees (MumTrees) 

retract (count (MumTrees) ) ,  !. 

assert_leaf_trecs (I, II) 

"  X  <  M, 

Iplusl  is  I  4  1, 
assert (tree (( I, Iplusl), [J, ())), 
assert_leaf_trees (Iplusl, H) ,  1. 
assert_lea£_trees (N, M) 

assert  (tree([M,lJ,  [],  ())),  !. 

/*  Succeeds  if  bdrys  I,J  ,  J, K  ,  and  I,  K  are  joined  at  one  point  */ 

succeed_it_ joined (I,<J, I) . 

s'jcceed_if_ joined  (I,  1,0)  . 

succecd_if_ joined  (.J,  X,  I)  . 

succeed_i£_ joined (X, J, K) 

ordered (I, J, 11, JJ) , 

tbdry (_,_, (II, J1 J , (Xi j, Yi j |Bi j J , (LXi j, LYi j) ) , 
ordered  (J,  K,  J2,  K2) , 

tbdry  (_,  ,  (J2,K2),  (Xjk,.Yjk|Bjk) ,  (LXjk,  LYjk) ) , 
ordered  (I,  X,  13,  K3) , 

tbdry (_,_, |I3,K3J, (Xik, YikIDik] , (LXik, LYik) ) , 

niatch_3_pts  (Xi  j,  Vi  j,  LXi  j,  LYi  j,  X jk,  Y jk,  LX  jk,  LYjk,  Xik,  Yik,  LXik,  LYik) ,  !  . 

/*  Succeeds  if  there  is  a  match  among  any  permutation  of  the  three  */ 

/*  pairs  of  points;  first  check  for  exact  matches:  */ 

match_3_pts (X, Y,  ,  ,X,y,  ,  ,X,Y,  ,_)  . 

matclfVpts  (_. _,  x,  y,  x,  y x,  y,l,  ) . 

match_3_pts  (X,  Y, _, _, _, _,  X,  Y ,  X,  Y . _,~J  • 

mateh~3_pts  (_,_,  X,  Y,~,“,  X,  Y,  X,  Y,  _,_)  . 

match_3_pts  (X,  Y,  _,  _,  X,  Y, X,  Y)  . 

matcli_3_pts  (_, _,  X,  Y,  X,  Y,~,~, ,  X,  Y)  . 

mat ch_3_pt s  (X,  Y,  _, _, X,  Y,  “,  “,  X,  Y)  . 

match_3_pts  (_,_,X,  Y,_,_,  X,  Y,  _,~,  X,  Y)  . 

/*  If  no  exact  matcli,  check  for  approximate  matches:  */ 
match_3_pts  (XI ,  Y1 ,  _,  _,  X 2,  Y2,_,_,  X3,  Y3,_,_) 
wj  thin_loJersnce  (XI ,  Yl7x2,  Y2) , 
wi  thin_toIerance  (XI,  Y1,X3,  Y3) , 
wjthiii~toJcrance  (X2,  Y2,  X3,  Y3) ,  !  . 
match  ^pts(_,7,  XI,  Y1,X2,Y2,_,_,X3,Y3,_,_) 
witl»in_tolerance  (XI ,  Yl,  X2,  Y2) , 
wi  thi  intolerance (XI,  Y1,X3,  ¥3) , 
wi  t-hi n~t olerance  (X2,  Y2,  X3,  Y3) ,  I  . 
ir.ntch_3_pt?  (Xl7Yl » _» X2,  Y2, _,  ,  ,_,X3,Y3) 
vi  thi  intolerance  (XI.  Ylj  X2,  Y2) , 
wifhxn7toJerar.ee  (XI,  Y1,X3,Y3) , 
mJ  flu  intolerance  (X2,Y2,X3,Y3),  !  . 
matcln3_pts(_,7,Xl,  Yl,X2,Y2,  ,  ,  ,  ,X?,Y2) 
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wlthin_tolerance  (XJ ,  Yl,  X2,  Y2) , 
within_tolerance  (XI,  Yl,  X3,  Y3) , 
within_tolerance (X2, Y2, X3, Y3) ,  ! . 
match_3_pts(Xl,Yl,_,_,_,_,X2,Y2,X3,Y3,_,_)  :  • 
wi thin_tolerance  (XI ,  Yl, X2,  Y2) , 
within_to!erance (XI, Y1,X3, Y3) , 
within_tolerance (X2, Y2,  X3, Y3) ,  ! . 
match_3_pts(_,~,Xl,Yl,_,_,X2,  Y2,X3,  Y3,_,_) 
within_tolerance(Xl,Yl,X2,Y2) , 
within_tolerance  (XI,  Y1,X3,  Y3) , 
within  tolerance  (X2,  Y2,X3,Y3) ,  !. 
match_3_pts  (Xi7y1,  X2,  Y2,_,  X3,  Y3>  :  - 

within_tolerance  (XI, Y1,X2, Y2/ , 
within_toJ.erance  (XI,  Y1,X3,  Y2) , 
within_tolcrance (X2, Y2, X3, Y3) ,  ! . 
match  _3_pts  (_,  _,  XI ,  Yl ,  X2,  Y2,  X3,  Y3 J  :  - 

wit(iin_tolerance  (XI ,  Yl ,  X2,  Y2) , 
wifchin_tolerancc (XI,  Y1,X3,Y3) , 
within_tolerance (X2, Y2, X3, Y3) ,  ! . 

/*********  "elim_incomplete_tree3"  subordinate  predicates  ****»«**«/ 

y«*»A»*»»***«A*dA***A*4****  *  *  A  A»AAA***AA**»A4«AAAAAAMA****l(AAA****«*^ 

/*  Succeeds  if  top  node  of  tree  is  anchored  to  an  edge  by  means  of  */ 
/*  an  edge-intersection.  If  so,  the  tree  is  'complete',  sii.ee  »/ 

/*  each  leaf  node  is  anchored  by  means  of  a  region  vertex.  */ 

complete__tree  (tree  ( (1, 0) ,  L,  R) ) 
ordered (I, J, 11,31) , 
tbdry  (_»_»  (11,01),  [X,  Y|B) ,  LPt) , 
cdge_bdry_intersection (_, (11,01), (X, YJ) ,  ! . 
complcte_tree  (tree  ( (1,0) ,  L,  R) ) 
ordered  (I,  0, 11,01)  , 
tbdry  (_,_,  (II, 01) ,  (X,  Y | nj ,  LPt ) , 
edgc_bdry_intersection(_, |ll,01),LPt) ,  !. 

/*  Retracts  all  bdrys  associated  with  nodes  in  'tree'  */ 
climinate_tree_tbdrys ( ( ) ) . 
e^iminate_tree_tl)drys  (tree  (|  1,0] ,  L,  R) ) 

retract_succeed (tre* < (I, 0) ,_,  )] , 
ordcr-dU, 0,1 1,01.) . 

rctr.i.-’  _succeed  (tbdry  („,_,  (11,01 ),_,_) } , 
elimj  nate  ^tree^bdrys  (L) , 
eliminate_tree_tbdrys (R) ,  ! . 


/***********  "f ind_exnct_opp_pt"  subordinate  predicates  **»•»»»**■**♦/ 

update_oop_cdge  (1,0,  (LX,  LY,  c  (C)  ,X2,  Y2|0P) ) 
opposite_edge  (0E) , 

update_opp_edg?2(1, 0,  (LX,  LY,  c  (C)  ,X2,  Y2|OFJ  ,0E) ,  i . 

update_opp_cdge2  (1,0,  (l.X,  LY,  c  (C)  ,X2,  Y2|0P) ,  (Xa,Ya,  ll,Xb,Yfc}0E)) 
oil  I  i •«»  (L-w,  t-Y,  ,<6,  y>>.  Xb,  ■■>') , 
retract  (opposite  edgefQEO) ) , 

update  op/._edge3T(LX,  LY,  X2,  Y2J ,  (Xo,  Yn)  ,OB0,OEl) , 
assert (opposite_edge (QE1 )) ,  !. 

•jpuat e_opp_edg  2(1,0,  (LX,  LY,  c  (C) , X2,  Y2 IOP) ,  (Xo,  Ya,  II, Xb,  Yb!OE) )  i- 
~  updat«_opr.e<lgt'2(l,0,  (LX,  LY,  d(C) ,  KZ,  Y2  Iff ) ,  (Xh,  YblOf.J  ] ,  '. 
update_opp_e?.'ge2  (1,  J,  (LX,  LY,  c  (C) ,  X2,  Y2  lorj ,  [ ) )  . 

/*  If  OP  is  counterclockwise  along  opp  edge:  */ 
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update_opp_edge3  ( ( LX,  LY,  X2,  Y2) ,  (Xa,  Ya] ,  (Xa, Ya,  II,  Xb,  YblOEO) , 

”  (Xa,  Ya,  h  (o)  ,  X2,  X2,  h  (ccw)  ,  LX,  LY,  H,  Xb,  YblOEO) )  i- 
on_ray  (X2,  Y2,  LX,  LY,  Xa,  Yc) ,  !  . 

/*  If  OP  is  clockwise  along  opp  edge:  */ 

update  opp  edge3 ( (LX, LY,X2, Y2J , {Xa,Ya], [Xa, Ya, H, Xb, YblOEO] , 

(Xa,  Ya,  II,  b2,L2,h(cw),X2,Y2,h(o),Xb,  YblOEO)) 
on_ray  (X2,  Y2,  LX,  LY,  Xb,  Yb) ,  !  . 

/*  If  OP  is  neither  clockwise  or  ccw  then  it  goes  into  HCA  interior  or  it  */ 
/*  goes  toward  goal  into  HCA  exterior,  so  it  says  nothing  about  opp  point  */ 
update_opp_edge3((LX,  LY,X2,Y21,  (Xa,YaJ,  [Xa,  Ya,  H,  Xb,  Yb|OEOJ , 

(Xa,  Ya,  II,  Xb,  YblOEOJ)  !. 

/*  If  LX, LY  is  not  on  current  opp  edge  segment,  recurse  to  next  segment  */ 
update_opp_edge3(|LX,LY,X2,Y2J,  [Xa,YaJ,  (Xb, Yb, HIOEO) ,  [Xb, Yb, IIIOEl J ) 
not (same ((Xa,YaJ, (Xb,YbJ)), 

update_opp_edge3  ( (LX,  LY,X2,  Y2J ,  (Xa,  YaJ  ,OEC,,OEl) ,  ! . 


/***********  "update_opposite_edgeM  subordinate  predicates  **»*»***/ 


/*  new_opp_pL  finds  a  new  (£  correct)  opposite  point  if  one  is  */ 

/*  present,  or  rtns  orig  opp  pt.  It  it  recurses  thru  whole  list  */ 

/*  with  h (o)  for  each  edge,  initial  opp  pt  was  good.  If  it  */ 

/*  finds  a  label  other  than  h(o),  then  it  needs  new  opp  point.  */ 

new_o;>p_pt  (_,  h  (o) ,  (Xopp,  YoppJ ) 
opposite_point (Xopp, Yopp) ,  ! . 
new_opp_pt  (_,  (XI,  Yl,  I:  (C)  ,  X2,  Y2|OE| ,  F) 

newopp  pt(JXl,YlJ, (X2,Y2|0EJ,P),  !. 
new_opp_pt  (_,  (xl,  Yl, h  (ccw) ,  X2,  Y2,_, X3,  Y3J ,  P) 
optimal_patli  ( (XI,  Yl  l_) ,  Cccw)  , 
oe_bisectiorx_search  (X2,  Y2,  X3,  Y3, Xcw,  Yew) , 
optimal_path ( (Xcw, Ycw|_J ,Ccw) , 
calc_opp  pt  (Xi,Yl, Xcw,  Yew, Cccw, Ccw, P),  |. 
ncw_opp_pt ( |X0, YO) , (Xl, Yl, h (cw) , X2, Y2 |_J , P)  : - 
optimal_path ( (X2, Y2 |_J ,Ccw) , 
oe_bisectioii_search (Xl, Yl, X0, YO,  Xccw, Yccw) , 
optimal_path ( [Xccw, Yccw|_J , Cccw) , 
calc_opp_pt (X2, Y2, Xccw, Yccw, Ccw, Cccw, P) ,  ! . 


oe  bisection_search  (Xl,  Yl,  X2,  Y2,  X,  Y)  : - 
XiO  is  Xl  4  (X2-X1J/2, 

YiO  is  Yl  4  (Y2-V))/2, 

round_to_4decpl (XiO,Xi) , 
round  to_4decpl (YiO, Yi) , 
optimal  path  ( (Xi,  Yi,c(C) , X,  Y|OF ) ) , 
on_linelx,Y,Xl, Yi,X2, Y2) , ! . 
oe  bisection  search (Xl, Yl, X2, Y2, X, Y) 

XiO  Is  Xl  4  (X2-XI ) /2, 

YiO  is  Yl  4-  (Y2-Y1J/2, 


/*  Bisect  edge;  compute  OP  */ 
/*  from  tridpt;  if  OP  starts'/ 
/*  along  edge,  this  is  the  */ 
/*  point  wc  are  looking  for*/ 


/*  If  OP  does  not  start  on  */ 
/*  edge,  search  between  */ 
/*  point  1  and  point  i.  */ 


round_to_4decpl (XiO,  Xi) , 
round_to_4dccpl (YiO, Yl) , 
not (within_toleronee (Xi, Yi,Xl, YJ ) ) , 
oe_bisectioii_search(Xl,Yl,Xi,Yi,X,Y)  ,  ! , 
oe_bisection  search (X1,YJ,X2,Y2,X,Y) 

Xi  is  Xl  I  (X2-Xl)/2, 

Yi  is  Yl  4  (Y2-YD/2, 
wit hi n_tole ranee (Xi, Yi, Xl, Yl) , 
tel) (mInsing_ops) , 
write  ('H«*ed  OP  for  start-point  '), 
write  ( (Xi,  Yi  )  | ,  nl, 
tel  l  (user) , 

write {'WARHIH'S:  missing  optimal  path  from  opposite  edg**'),nl, 
w-lte('  for  predicate  "oe  bisection  search" '), nl,  I 


/* 

/* 

/* 

/* 

/* 


If  no  correct  OP  is  '/ 
found,  return  Pt  1  as  */ 
answer.  This  case  '/ 
SHOULD  HOT  IIAPPRII,  so  */ 
print  a  warning.  */ 


************ *»*.***********»**»*»*•»*»«*»*»*»****/ 
/«»«*••»**»*»**»»  "output"  subordinate  predicates  ***»»»«*******»'»/ 
/******** . ** . .  . . . . . 


write_bdrys_to_file (hca_opm, ID . 

write_bdrys_to_file  (iica_opm,  1 1(1, 0 J ,  D,  LFt  J  I.BdrySet) ) 
tell  (hca_opin) , 
write  ('bdry  (' )  , 

write  ( 1 1 ,  J) ) ,  write  {' , ' ) ,  write  (B) , 
write  (' )  .'),nl, 

write_bdrys__to_£ile  (hca__opn,  BdrySet )  . 

write_iter_to_screen  : - 

retract (number_of_iter (1 ) ) , 

Iplusl  is  1  ♦  1, 

assert  (number_o£_iter  (Ipiusl) ) , 

tell (user) , 

write (' consistency  check  ' ), 
write (I) , nl,  !. 
write__heading 

r  >gion_vertices ( (X, Y | RJ ) ,  goal_point (Xg, Yg) , 
cons (IX, Yin), (X, YJ, Region), 
tell  (lica__opw) , 
listing (title) , 

write  ('  region  (' ) ,  write  (Region) .  write  {' )  .' )  ,nl, 

write  (  v-'al  ( I ' ) ,  write  (Xg) ,  write  (' , ' )  ,  write  (Yg) ,  write  i' )  5  '  )  ,nl, 
listing (tree! ,  1  . 

write_to_screen (X) 
tell (user) , 
write  (X) ,  nl,  ! . 


/*»**'■* *»»•»***•**»*♦*«  utility  predicates  *♦»»*»*****»*»*»**»****•<>/ 
/*** . . . * . * . **************** . ***'*/ 


/*  Succeeds  j£  line  segments  int 
interior_intoc3eetion ( (X) ,  Y1 1 HI J 
not  (seme  (Lrtl,  tFt?) ) , 
not  (same  ( |X) ,  Y1 ) ,  (X2,Y2J 
not (same ( |X1, Y1 I , bFt2) ) , 
not (same (|X2, Y2J , LFtl) ? , 
bdry_i  liter  sect  ion  (1X1,  Y1 
interior_int2rsection ( [XI, Y1 |B1) 
bdry_intersection ( [XI,  Y1 


ersect,  but  do  not  share  an  endpoint,  V 
,  LFtl,  (X2,  Y2 1 B2 ] ,  l/Ft 2,  IntFt,  Bltr,  B2tc) 

/*  If  inters  at  endpt,  lulls?  i£  not,*/ 
)),  /*  and  intersects  somewhere,  succeeds*/ 

/*  Assumes  31  <  B2  intersect  *-/ 

/*  in  at  most  one  point.  */ 

1 01 ) ,  |X2,  Y2 1 02) ,  IntFt,  Bltr,  02tr) ,  !. 

, IJ, |X2,Y2|B2J, H,IntPt,Bltr,B2tr)  '.••  /'Full*/ 
|B1J, (X2,Y2|02j, IntFt, Bltr, B2tr),  !.  /‘bdvyW 

/«  Full  bdrys'/ 


/• 

*  *bdry_infcorocction'  determines  tlie  intersection  o£  two  boundaries, 

*  or  fails  i£  tliere  is  no  intersection.  The  boundaries  are 

*  piecewise  linear, and  are  represented  as  a  list  of  points, 

*  ie,  lxl,yl,  x2,  y2,x3.  y3.  . .  .J  .  Tolerance  is  allowed. 

*  Once  an  Intersection  is  found,  it  is  cached  to  speed-  up  future  references  */ 
bdry_inter3CCtion (01, 02, (Xi2, Y12J , Bltr2, D2tr2) 

bdry  intersection]  (appr.,  01,  B2,  |Xi,  Yi) ,  Bltrunc,  B2trunc) , 

Xi2  Is  (floor (Xi *10000) /10000) , 

Yi2  is  (floor (Yi*10000)/I0000), 
repJoce_Jost_coords (Dltrunc,  (Xi2,  Yi2) ,  Bltr2) , 
rcplace^last_coord3 (02trunc, (Xi2, Yi2J, D2t  r2) , 

U3scrta  (bdry_in ter sect ion (B) , 32, (Xi2, Yi2) ,  Bltr 2, B2tr2) ) ,  f . 


/*  '  bdry_intersection_exact'  is  like  '  bdry_intersection' ,  except  that 

*  no  tolerance  is  allowed  on  intersection  point  being  interior  to 

*  both  bdrys,  and  bdry_intersections  are  not  cached.  */ 
bdry_intersect.ion_exact  (HI ,  B2,  (Xi2,  Yi2J ,  Bltr2,  B2tr2) 

bdry  intersectionl {exact,  B1,B2,  [Xi,Yi J , Bltrunc, B2trunc) , 

Xi2  Is  (floor  (Xi*lOO00) /10000) , 

Yi2  is  (floor (Yi *10000) /10000), 
replace_last_coords  (Bltrunc,  |Xi2,  Yi2) ,  Bltr2)  , 
replace_last_coords (B2trunc, (Xi2, YiZJ , B2tr2) , ! . 

/*  Check  ,l£  a»y~segmont  of  bdry  1  matches  the  1st  segment  of  bdry  2.  »/ 
bdry^i  liter  sect  ion  1  (Prpc,  [Xll,  Yll,  X12,  Y12 1  Bl] ,  [X21,  Y21,  X22,  Y22  |B2J ,  [Xi,  Yi), 
Bltrunc, B2trunc> 

bdry  iiiterseetiori2  (free,  (X11,Y11,X12,Y12|B1), 

(X2i7y2I,X22, Y22),  (Xi,Yi) ,  Bltrunc,  B2truneJ ,  ! . 

Z1*  Recursively  check  the  next  segment  of  boundary  2  with  all  of  bdry  1 .  */ 

bdry_intersectionl (Free, [XI 1, Yll, X12, Y12 ] Bl),  [X21, Y21,X22, Y22 |B2J , [XI, Yi), 
Bltrunc, [X21, Y21 |B2truncl ) 

bdry_intersectionl (Free, (Xll, Yll, X12, Y12 | Bl J , 

(X22?f22 (B2J, (Xi, YiJ, Bltrunc, B2trunc),  !. 

/*  Recursively  see  if  any  seg  of  bdry  1  matches  the  1st  segment  of  bdry  2.  */ 
bdry  intersection^ (appx, (Xll, Yll , X12, Y12 ! Bl] , 

[X21.  Y21,  X22,  Y22] ,  (Xi,Yi|,  [Xll,  Yll,  Xi,  YiJ  ,  [X21,  Y21,  Xi,  Y.i) ) 
line_int*r.-ecciow  (Xll,  Y21,  3112,  Y12, X21,  Y21,  X22,  Y22,  Xi,  Yi) , 
between  (X i, Xll, Xj”),, 

between  (YS,Y)  1 -Y12)  ,  /*  Check,  if  pt  i  is  between  */ 

between  (Xi./K^l,  X2?) ,  /*  endpoints  of  both  segments  */ 

between (Yi, Y21, Y27) ,  1.  /*  inclusively  */ 

bdry_inters*cLioii2  (appx,  [XI 1,  YI  1,  XI 2,  Y.12 )B1 1 , 

[X21 , Y21 , X22, Y22) , (Xi, Yi), (Xll , YI 1 (Bltrunc) , BZfcrunc) 
bdry  intersection^ (fip;,?:,  (X12,X12[B1}, 

[>:?l^Y21tX22,Y22J,  [Xi,  Yi  ), Bltrunc,  BZtrunc) ,  !, 
bdry  intersection2(exect, [Xll , Yll, X12, V121B1 ), 

[X21,Y21,X22,Y22J,.r:ci,yiJ,  (Xll,yU,Xi,Yi),  [X31,  Y21 ,  Xi ,  Yi  J ) 

1  ins  .intersection  (Xll,  XI1,X12,  Y12,KS1,  Y2l,x22,  222,  Xi,  Yi) , 
c;:act_betwee«  (Xi,  Xi  1,  X12) , 

cxact_betwccnlYi, Yll, i32),  /*  Check  if  pt  i  is  between  */ 

<*xart__hetwe_en(XJ,X2J,X22},  fr-  enbpoi nts  of  botli  segments  */ 

•?*snct_bct;w»eriC'j .  Y21.Y22),  J.  inclusively  »/ 

bdry  iiitersection2 (exact,  [X11,.Y11,X12,  Y12|B1J, 

|X21,Y21,K22,Y22),  (Xi, Yi),  (Xi ' /YU ) Bltrunc} J32Srune> 
bilcy  intersection?,  (erect,  (XJ2,  Y12)BX5, 

(X2l7Y21,  X22,  Y22J  ,  [Xi,  Yi  J,  OJ  treOfl,  82tru?iC) ,  !  . 

replace_lasl_<r-oord«  -  |X,YJ,  [X, ’/))  , 

replace  _last_coords  ( (Xi,  Yi)b),  [X,YJ,  lKi,  Yi[L2J)  :  * 
replacs_la3t_coords  (),,  (X,Y)  ri2‘.<  !  i 

gefc_tbdcy IJordl  (f ,C,  (!,.•?)  , 6,  Art )-  l.hdry(F,C,  [X,  J),  B,  LPt)  . 
g*tJ.bd</Jdordl  (7,C,  [t,  .JJ  ,B,  i,Pt »  fcbvJry(K,(\  f  O’,  U .  B,  IPI)  . 

reassert .rbdrys  (f,  !  j.,  Ot  r)  , 
reaasert.tbdrys (F,  ( [  [1, <?J , S, iCtJ-JMjt'Gfcej  \- 
assext  (Uidry  (F,Ctr,  J  1,0),  B,  Lft)  ? , 

C2  i,-? 

rcasse£fc_tbdry3  (;  ,A3,  C2)-, 
order  i»)d)c*»8([J,  [.))  s»  (. 

ordcr^indices s l(  fjUdJjB,I.Ptl  (Pspij,  [  { [i-i,  Jl|r.7,  i?t)  iKav-lscoReat) ) 
c-dered(X, 

srder.ind ices  (Rest,  Bevijviltsotl ,  f. 

adjacent  MtysMi,  J,  f-  ! . 

•vljaceii1  _!“!«>  s  (1,  >1,  K,  v,  I,  v*,  *7,  It)  i'  - 


adjacent_bdrys (1,  J,  K,  I,<),  I,  I,  K)  !. 

ad jacent_edges (I, J)  J  is  I  ♦  1. 

ad  jacent_eclges  (1,  II)  nunvbar_of_edges  (II)  . 

get_initbdryIJorJI (I, J, B)  initbdry ( l I, <JJ , B) . 

get_initbdcyI3orJI  (I,  J,  B)  initbdry  ( [-7, 1  ] ,  8)  . 

get_tbdrys (_)  : - 

assert (bdry_list ([])), 

tbdry  (_,_,  [I,  J) ,  B,  IPtB) , 

retract  cut  (bdry  list(L)), 

assert (bdryJListl ( ( (1, J) ,  B,  LPtB) |L] ) ) , 

fail . 

get_tbdrys (ft)  retract (bdry_list (ft) ) ,  !. 

reset_last_pts  /*  Insures  that  intersecting  */ 

tbdry (FI, Cl, (I,JJ,B1, (bXl.LYl)) ,  /*  bdrys  have  identical  last  points  */ 

tbdry  (F2,C2,  (K,b)  ,B2,  |LX2,LY2J) , 

ad  jacent_bdrys  (1,0,  St,  L,  II,  01,  K1 ,  LI) , 

not (same ((1,0), (K, L] ) ) , 

wi thi intolerance  (LX1 ,  LY1 , 1,X2, 1.Y2) , 

retract_cut  (tbdry  (F2,  C2.'|K,  b) ,  B2,  [LX2,  I>Y2J ) )  , 

assertaTtbdry  (F2,C2,  {K,L),B2,  (LX1,  LYl J ) ) , 

fail,  ! . 

reset_lasL_pt3  !. 


edge_ad jacent_to_bdry (I, I,d) . 
edge_adjacent_to_bdry (0, 1,0). 

bdry_starts_at_edge(l,0,0) 
bdry_3tarts_at_edge (1,0, 1 ) 
bdry_starts_at__edge  (1,11, 1) 
bdry_starts_at_edge(l,ll,ll) 
bdry_starts_st_edge  (II, 1, 1) 
bdry_starts_at_edge  (II,  1,  II) 


Diff  is  1-0,  abs  (Dif f,  1) ,  !. 
biff  is  1-0,  abs  (Diff,  1),  ! . 
number_o£_edges  (II) ,  ! . 
number_of_edges (H) ,  ! . 
niimber_of_edges  (M) ,  ! . 
number_of_edges  (II) ,  I . 


/*  Opp  Ft  is  located  proportional  to  OP  costs  at  each  end  *1 
calc_opp_pt  (XI,  Y1,X2,  Y2,C1,C2,  (Xopp,YoppJ) 
distance  (XI,  Y1,X2,  Y2,D12) , 

DelX  is  X2  -  XI,  Del Y  is  Y2  -  Yl, 

XoppO  is  XI  +  ( (D1 2-IC2-C1 ) /D12) * (De)X/2) , 

YoppO  is  Yl  +  ( (D12+C2-C1) /D12) * (DelY/2) , 
round_to_4decpl (XoppO,  Xopp) , 
round_to_4decpl (YoppO, Yopp) ,  ! . 

/*  Rounds  off  a  number  to  four  decimal  pieces  (to  allow  unification  */ 
/*  with  manually  input  optimal  paths)  */ 

round_to_4decpl(X,Xr)  Xr  is  (floor ( (X!0. 00005) *10000) ) /10000 
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/A********************** ft ************************************************ 

*************************************  *********************************** 

* 

*  "bgutils"  contains  supporting  predicates  used  by  the  Hbg"  files. 

* 

*  Consulted  and  called  by  "bg". 

* 

*  Updated  12  Jan  89. 

A 

***************************************  ********************************* 

... ....... ...........................A.*....*.....*.. .........A........./ 

/*  COHS^AtlTS:  Dimensions  of  input  map  */ 

minX(O). 

maxX (60)  . 

mlnV  (0)  . 

max* (100)  . 

pi  (3. 14159)  . 

/*  "precision"  is  the  max  number  of  line  segments  to  compute  */ 

/*  for  each  lvis  boundary,  and  twice  the  number  for  2vis  boundaries.  */ 
precision (20) . 

tolerance(0.05! .  /*  Pts  closer  than  this  are  usually  not  distinguished  */ 

/*  tolerance (0.015) .  */ 

^***A*A*  *  *  *  *  *******************>***************.********************** J 

general  utility  predicates  **.**.**»***..*.*.*./ 

.A............................ 

between (B, A, C) 

tolerance (T) , 

Bplus  is  B  I  T, 

Cplos  is  C  +  T, 

A  "<  Bplus, 

B  -<  Cplus,  ! . 
between (B, A, C) 

tolerance (T) , 
bminus  is  B  -  T, 

Cminus  is  C  -  T, 

A  >"  Bmittus, 

B  >«  Cminus,  ! . 

exact_between(B,A,C)  s- 
A  »<  D, 

B  -<  C,  !  . 

exact_bctween(B,A,C) 

A  >~  a, 

B  >"  C,  !. 

strictly  between  (13,  A, C) 

A  <  B, 

B  <  C,  !  , 

strictly_betwecn (B, A,C) 

A  >  E, 

B  >  C,  ! . 

go  t_cauiit.or_and_  increment  (Ctr) 
retract  (ctr  (Ctr) ) , 

Cplus 1  is  Ctr  I  1, 
assert,  (et  r  (-"plusl ) ) ,  ! . 
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ordered  (I,  J,  I,  J) 
ordered  11,0,0,1) 


aba (X, X)  X  >-  0. 

abs  (X,  Y)  X  -<  0,  Y  is  -X. 

retract_succeod (F)  retract  (P),  !.  /*  Always  succeeds,  fails  on  backtrack  */ 

retract_succeed (_)  !. 

retract^ cut (P)  retract (P) ,! .  /*  Retracts  P,  fails  on  backtracking  */ 

unify_cut(P)  call(P),!.  /*  (lets  1  .it  instance  of  r,  fails  on  liarktracking  */ 

/*  fails  the  first  time  called,  then  succeeds,  toggling  thereafter  */ 
fail_succeed  not (failed),  assert (failed) ,  1,  fail,  !. 
fail  succeed  failed,  retract (failed) ,  !. 


get_last_pt (IXlast, Ylast], Xlast, Yl93t) . 
get_last_pt ( (X, Y I  Rest] ,  Xlast,  Ylast)  : - 
get_last_pt (Rest, Xlast, Ylast) . 

get_last_list ( (Last) , Last)  . 
get_last_list ( ]F| Rest] , Last) 

get_last_list (Rest,  Last)  . 

within_tolerance (XI, Y1,X2,  Y2) 
tolerance (Tolerance) , 

DelX  ‘.a  XI-X2, 
oelx  <  Tolerance, 

DelX  >  -Tolerance, 

DelY  is  Y1-Y2, 

DelY  <  Tolerance, 

DelY  >  -Tolerance,  !. 

same_set (Setl, Set2) 

same (Setl, Set2) ,  i. 
same_set ( (AlSctl) , Set2) 

match_and_de.lete  (A,  Set2,  Set2LessA) , 
same_set (Setl,Sefc2LcssA) ,  *. 

match_and_deiete (A, I A] , ( ) ) . 
match_and_de.lete  (A,  |A|  Rest  J ,  Rest)  . 
match_and_delete (A, ]D|Set], ( D I SethessA] ) 

>natch_and_delete  (A,  Set,  SetLessA)  , 

/*  input:  starting  and  ending  integers  */ 

/*  output:  list  of  .lists  of  the  form  ]  (1 , 2J ,  (2, 3J , . . .,  |»l-l,  HJ ,  fit,  3  )  J  */ 
/*  where  an  index  pair  appears  the  num  of  times  its  initbdry  appears  */ 
indc.-._liot_ltoJ(d,0,  Ud,  1JJ)  . 

index~list”ltoJ (1,0, l |I,Iplusl] ]RestJ) 

Iplusl  is  I  4  1, 

index_list_l tod (Xplu3l,d, Rest) ,  ! . 

returns  the  number  of  initbdry ( | I, JJ ,_)' o  asserted  */ 
number  _of_I«>_i  uiUidi  ys  (i,d,  II)  re¬ 
assert.  (temp_num(0) ) , 

InlrtdMuli*  a \  % 

inn  UUI.J  U»|VJ  , 

retract_cut (temp_mun(K) ) , 

P.plusl  is  X!  1 , 

assert  (temp  num(Kplusl) ) , 

fail,  ! . 

r.umber__of_  nitbdrya  (7,  J,  II) 

retrnct_cul.  (Uemp_muii (II) ) ,  !  . 
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/*  input:  list  of  3-element  bdry  lists  of  form  |f  [1,2],  B1 ,  L>Pt:l  |  -  . . .  J  */ 

/*  output:  list  of  lists  of  the  form  [  [1,2] ,  {2,3],  . . .  ]  where  eacli  »/ 

/*  bdry  in  input  list  is  represented  by  its  index  list  */ 

index  list  ( ( ) ,  U)  ! . 

index“listU[|I,Jl,_,_]|Rest],  t  [I.JJ  iRevList])  :- 
~  index_iist (Rest, RevList) ,  !. 

/>  input:  Mum  of  edges  and  list  a:,  indices  of  eacli  bdry  previously  asserted  */ 

/»  output:  list  of  indices  of  each  bdry  not  previously  asserted  */ 
complement_index_li3t (M, ( (1,2) I InList j , OutLi st)  /*  If  [1,2]  is  first  */ 

complement_index_listl (2,M, InList,  J ] ,  OutList) ,  !. 
complement  index  list (H,  InList, OutList)  :-  /*  If  [1,2]  is  not  first  */ 

complement  index_listl (2, H, InList,  [ [1, 2] ] , OutLi st) ,  !. 

/*  If  (1,2)  is  first  OR  loot,  do  not  include  it  in  complement  lint  */ 

/*  If  (1,2)  is  neither  first  H'.'R  last,  include  it  */ 
coniplement_inden__listl  (M,  M,  ( ( ,  First,  ( (It,  1)  |  First  1 1  1. 

complement_i  ndex_listl  (II,  M,  [  |M,  1) ),  First,  First)  :-  !. 

complement_indes_listl  (M, M,  ( { l,  2)  ] ,  first,  ( [SI,  1]  J)  :-  !. 

compiement_index_listl  (H,H,  [  [tl,  1) ,  [1,2] ),  first,  () )  :-  !. 

complement_ii>dex_listl  (1,11,  ( [I,  <3)1  Rest] ,  rirst,  RevIndexList)  :~ 

Iplusl  is  I  +  1, 

complemeni:_index_listl  (Iplusl,  H,  Rest,  rirst,  RevIndexList) ,  ! . 
ccmplement_index_J i atl  (1, 11,1  [«J, KJ ) Rest ] , rirst,  { (I,  Iplusl )  iRevindexList ] )  :- 
Iplusl  is  I  11, 
not (some (I, J*  J , 

compiemcnt_indox_ii3tl (Iplusl, », [ [ J,  K) (Rest] , First, RevlndexList) ,  1 . 

sftt_subtraction (L,  (),I.)  :-  !. 
set_subtra<r.tion(Ll,  [A|  t.2) ,  L4) 

deIcte_Crom_iist  (A,  LI,  L3) , 
set_subtraction (L3,  L2,  L4) ,  !. 

delete__Crom_l  int  (A,  [) ,;[  | )  :-  !. 
deiete_lrom_list (A, (A|L],L2)  :— 

delete_f  rorr_list  (A,  L,  L2) ,  ! . 
delete_f.rom_lisC  (A,  ( R I I.l ,  [b|L'2)l  :- 

delete  from  list  (A,  L,L2) ,  I. 


/* 

*  predicates  related  to  rotation  and  translation 


compute  angle  of_rotutio» (Xo,Yo,X, Y, Angle) 

“tieJX  is  X-Xo, 

He  IX  >«-  0, 

Del  Y  is  Y-Yo, 

Angle  is  -asin  (DelY/sgrt(0elX>'2inelY',2) ) . 
compute  angle  of  rotation  (Xo,  Yo,  X, Angle)  :- 
Del Y  Is  Y-Yo, 

Del Y  >t  0, 

DelX  is  X-Xo, 
t’i'RV  , 

Angle  is  -Pila3in  (DelY/sqrt  (DelX^S IDell’,'2) )  . 
compute_anglc_of_rotation (Xo, Yo, X, Y, Angle;  :- 

DclY  is  Y-Yc,  / *  ...wnen  the  angle  is  */ 

DelY  <  0,  /*  between  pi  A  3pi/2.  '/ 

DelX  is  X-Xo, 

piiri). 

Angle  is  Fi  I  as  in  (Deli  /  nqrt.  (DelX' 2 1  Del  Y  *2) )  . 

invert  bdry  :-  /*  Refiecto  the  boundary  */ 

retract (bdry (RJ) ,  /*  about  the  vertical  line  */ 


of  the  boundary. 


/*  Computes  angle  to  rot.*/ 
/*  the  x-axis  to  the  */ 
/*  vector  (Xo,  Yo)»>(X,  Y)  »/ 
/*  when  the  angle  is  */ 
/*  between  -pi/2  (■  pi/2,  V 

/*  ...when  the  angle  is  */ 
/*  between  pi/2  C  pi.  *7 


/*  X-Vx,  where  V.x  is  the  */ 
I*  bdry  vertex  or  last  pair*/ 
/*  of  coords  in  bdry  list  */ 


invert_bdry (R, Vx, U_inv) , 
assert (bdry (R  inv) ) ,  !. 
inv«rt_bdry  ( (X,  Y] ,  X,  (X,YJ)  . 
invort_bdry ( [X,  Y|R) , Xre£l, (Xinv, Yinv | RinvJ ) 
invercjbdry (R, Xre£l, Rinv) , 
invert_coords (X,  Y, Xre£l, Xinv,  Yinv)  . 
invert  coords (X, Y, Xre£l, Xinv, Y) 

”  Xinv  is  2*Xj.e£l  -  X. 

rotate_bdry (Angle) 

retract (bdry (L) ) , 
rotate_bdry  (I.,  Angle, trot) , 
assert (bdry (Lrot) ) ,  !. 
rotate_bdry((X, Y), Angle, X,Y, (X,YJ) .  /*  Assumes  last  item  in  */ 

/*list  is  bdry  vertex  */ 

rot.ate_bdry  ( (X,Y|L) ,  Angle,  Xo,Yo,  (Xrot,  Yrot  I  Lrot] ) 
rotate_bdry (L, Angle, Xo, Yo, Lrot) , 
tranalate_point (X, Y, Xo, Yo, Xtr,  Ytr) , 
rotate_poi.nt  (Xtr,  Ytr,  Angle,  Xrot  1,  Yrot  1) , 
re_tran»lat*_ point (Xrotl , Yrotl, Xo, Yo,Xrot, Yrot) . 
rotate_polnt (X,Y, Angie, Xrot, Yrot) 

Xrot  is  X*eos (Angle)  +  Y*sin (Angle) , 

Yrot  is  Y*cos (Angle)  -  X*sin (Angle) . 

rotate2_bdry (Angle) 

retract (bdry (L) ) , 
rotate2Jbdry (L, Angle, Lrot) , 
assert (bdry (Lrot) ) ,  !. 

rotate2_bdrv ( [X, YJ , Angle, X, Y, (J ) .  /*  Assumes  last  item  in  */ 

/•list  is  origin  of  rotation,  but  not  on  boundary  */ 
rotate2_bdry ( (X,  Y I L] , Angle, Xo, Yo, [Xrot, Yrot |Lrot) ) 
rotate2_bdry  (L,  Ai,g)  e,  Xo,  Yo,  Lrot) , 
tranalate_point  (X,  Y,Xo,  Yo,  Xtr,  Ytr) , 
rotate_point (Xtr, Ytr, Angle,  Xrotl,  Yrotl) , 
re_fcranslate_point (Xrotl, Yrotl, Xo, Yo, Xrot, Yrot) . 

translate_point  (X,  Y,  Xo,  Yo,  Xtr,  Ytr)  : - 
Xtr  is  X-Xc, 

Ytr  is  Y-Yo. 

re_transiate_point (Xtr, YtrrXo, Yo, X, Y)  : - 
X  is  XtrIXo, 

Y  is  Ytr4 Yo. 


/* 

*  Miscellaneous  utility  predicates. 

*/ 

debug^list (Filename) 

tel  1 (Filename) , 

1 1  sting  (t;«glon_v*rt(oes) ,  1  (sting  (t  J  tie) ,  1  inti  ng  (goal_poi  lit) , 
listing (tbdry) ,  listing (initbdry) , listing (tree) . 

reverse_J 1st  ( ( ) , ( | )  . 

revcrso_).  1st  ( [X 1 1.) ,  RevI.conoX)  • 

reverse_list  (I.,  UevL) , 
cons  (RevL,  i  X  j ,  RcvLounsXj  . 

reverse_eclge_l  ist  ( [X,  YJ ,  (X,  Y) )  . 

reverse __cdge_li.it  ( [X,  Y,  il { L) ,  Revl.consX)  * 

zever3e_edge_list  <L,  RevL) , 
cons  (RevL,  (II,  X,  Y  J ,  RevLconsX)  . 
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reverse  path  list  ( (X,  Y) ,  {X,  YJ )  !. 

reverse~path— list  (IX1,Y1,X2,Y2J,  (X2, Y2, XI, Yl) )  :-  !. 
reverse”patb”list{{Xl,Xl,X2,Y2,X3,Y3), [X3, Y3, X2, Y2, XI, Yl) )  !. 

reverse~path~list  ( 1X1,  Y1,X2,  Y2,X3,  Y3,X4,  Y4) ,  1X4,  Y4,  X3,  Tf3,  X2,  Y2,  XI,  XI) )  1 . 

reveise-path”list  ( (XI, Yl, X2,  Y2, X3,  Y3, X4,  Y4,  X5,  Y5 J , 

“(X5,  Y5,X4,  Y4,X3,Y3,X2,  Y2,Xl,Ylj)  :-  I. 
reverse  patti  list  ( )X1,  Yl, X2,  Y2, X3,  Y3, X4,  Y4,  X5,  Y5, X6,  Y6) , 

~)X6,  Y6,X5,  Y5,X4,Y4,X3,  Y3,X2,Y2,X1,Y1})  !. 

reverse  path_list  ({X1,Y1,X2,  Y2,X3,Y3,X4<  Y4,  X5,  Y5,X6,  Y6,X7,  Y7], 
“tX7,Y7,X6/Y6,X5,Y5,X4,Y4,X3/Y3,X2,Y2,Xl,Yl))  !. 

reverse_path  list  ((XI,  Y1,X2,Y2,X3,  Y3,X4,  Y4,X5,  Y5,X6,Y6,X7,Y7,X8,Y8J, 

1X8,  Y8,X7,Y7,,’<6,Y6,X5,Y5,X4,Y4,X3,Y3,X2,  Y2,X1,Y1JJ  !. 

reverse  path  list  ( (XI,  Yl,  X2,  Y2,  X3,  Y3,  X4,  Y4,  X5,  Y5,  X6,  Y6,  X7,  Y7,  X8,  Y8,  X9,  Y9) , 
|X9,Y9,X8,Y8,X7,Y7,X6,Y6,X5,Y5,X4,  Y4,X3,Y3,X2,Y2,X1,Y1J)  !. 

reverse_path_list { (X, Y|LJ , RevkconsXY)  s- 
reverse_path_list  (L,  Rev],) , 
cons (Revh,  (X, Y J , RevLconsXY) ,  !• 

/*  Return  the  point  of  intersection  of  two  lines,  fail  if  parallel.  */ 

/*  Rote:  next  4  rules  are  included  to  retain  precision  where  possible.  */ 

/*  If  lines  abate  a  point,  that  point  is  the  intersection:  */ 
line_i  liter  section  {X5 ,  Yl ,  X2,  Y2,  XI,  Yl,  X4,  Y4,  XI,  Yl)  !. 

line~inter sect ion (XI , Yl, X2, Y2, X2, Y2, X4, Y4, X2, Y2)  !. 

line_inter section (XI, Yl, X2,Y2,X3, Y3,X1, Y] , XI, Yl)  !. 
line_inter  sect  ion  (XI,  Y1,X2,  Y2,  X3,  Y3,  X2,  Y2,X2,  Y2)  !. 

line_'.ntersection  (XI,  Yl,  X2,  Y2,  X3.  Y3,  X4,  Y4,  Xi,  Yi) 

not  (X2-* >X1},  /*  Handle  separately  if  */ 

not(X4”"X3),  /*  one  line  is  vertical  */ 

Ma  is  (Y2-Y1) / (X2-X1) ,  /*  Slope  of  1st  line  *> 

Ba  is  Yl-Ma*Xl,  /*  Y-intecept  of  1st  line  */ 

tlb  is  (Y4-Y3)  /  (X4-X3) ,  /*  Slope  of  2nd  line  */ 

Db  is  Y3-Mb*X3,  /*  Y-intecept  of  2nd  line  »/ 

not (Mb»»Ma) ,  /*  This  happens  if  lines  are  parallel  */ 

Xi  is  (Ba-Bb) / (Mb-Ma) , 

Yi  is  Mb*Xi  J-  Bb,  ! . 

line_inter sect ion (XI , Yl, XI, Y2, X3, Y3, X4, Y4, Xi, Yi)  : - 

not (X4"«X3) ,  /*  Case  where  1st  line  is  vertical  */ 

Mb  is  (Y4-Y3) / (X4-X3) ,  /*  rails  if  both  lines  vertical  */ 

Bb  is  Y3-Mb*X3, 

Xi  is  XI, 

Yi  is  Mb*Xi  +  Bb,  ! . 

line_intersection (XI, Yi,X2, Y2, X?, Y3, X3, Y4, Xi, Yi) 

not(X2"=XX),  /*  Case  where  2nd  line  is  vertical  */ 

tla  is  (Y2-Y1)  /  (X2-X1) ,  /*  rails  it  both  lines  vertical  */ 

Ba  is  Yl-Ma*Xl, 

Xi  is  X3, 

Yi  is  Ma*Xi  +  Da,  !. 

line_intcr  sect  ion  (XI,  Y1,X2,  Y2.X1,  Yl,  X2,  Y2,X1 ,  Yl)  .  /*  If  lines  are  identical  */ 

/{‘  return  ttie  1st  vertex  as  intersection  point.*/ 
line_inter sect ion (XI, Yl, XI, Y2,X1 , Y3, XI. Y4, XI, Yl) .  /*  Case  where  lines  are  */ 

/*  vertical  £  coincident;  return  1st  vertex  of  1st  line  as  int  pt.  */ 
line_lntersection (XI, Yl, XI, Y2, X3, Y3, X3, Y4, Xi, Yi)  /*  Case  where  lines  are  */ 

!,  foil.  /*  both  vertical,  but  not  coincident;  fail.  */ 

line_intersection(Xl,Yl,x2,Y2,X3, Y3,X4,Y4,X1, Yl)  /*  Coincident  lines  */ 

not  (X2»«Xl) , 
not  (X4'>»X3) , 

I  la  is  (Y2-Y1)  /  (X2-X1) ,  /*  Slope  of  1st  line  */ 

Ba  is  Yl-Ma*Xl,  /*  Y-intecept.  of  1st  line  */ 

Mb  i 3  (Y4-Y3) / (X4-X3) ,  /*  slope  of  2nd  line  */ 

Rb  is  Y3-Mb*X3,  /*  Y-intecept  of  2nd  line  */ 

Ma»*-MI»,  /*  Parallel  */ 

Bn”Db,  !.  /*  Same  y-inlercepts  */ 

/*  If  linc3  are  coincident,  return  lot  vertex  of  l»t  line  as  int  pt  */ 


virtual  vertex (XI , Yl , X2, Y2, X3, Y3, X4, Y4, Xv, Yv)  /*  the  virtual  vertex  is  *1 

~line_inter sect ion (XI,  Yl,  X2,  Y2, X3,  Y3,  X4,  Y4,  Xv,  Yv) , 1 .  /*  the  point  of  */ 

/*  intersection  of  the  lines.  */ 


distance  (XI,  Y1,X2,Y2,D) 

D  is  sqrt ( (X2-X1) A2  +  (Y2-Y1)  A2)  . 

/*  Counts  length  of  a  list  */ 
liat_length (( J ,  0) . 
list_length ( IXIRest) , Tplusl) 
list_lengtli (Rest, I) , 

Iplusl  is  I  +  1. 

/*  Computes  length  of  path  P  -V 
patli_iength  ((1,0). 
path_lengtli  { (_,_) ,  0)  . 

path”length((Xl7vi,c(C) ,X2,Y2|P),D) 
path  length ( [X2,  Y2 | p) , Dl) , 
distance  (XI,  Y1,X2,Y2,D2) , 

D  is  D1  +  C*D2,  I . 
path_length ( (XI, Y1,X2,  Y2 |P* ,  D) 

path  length  ( |X2,  Y2 1 P] ,  01) , 
distance (XI, Y1,X2,Y2,D2) , 

D  is  Dl  +  D2,  ! . 

/*  Computes  length  of  edge  P  */ 
edge_length  (0,0)  . 
edqe_length ( (_,  J ,  0) . 
edge  JLength ( (X17y1 , V,X2,Y2|P) , D)  :  - 
edge  length ((X2,Y2 I P), Ul) , 
distance (XI, Y1,X2,Y2,D2) , 

D  is  D1  +  D2,  ! . 


/*  If  cost  data  is  present,  find  */ 
/*  weighted  cost  of  path;  */ 


/*  If  cost  data  is  not  present,  *1 
/ *  find  Euclidean  length  of  path  */ 


/*  Computes  the  distance  between  pts  1  f.  2  along  path  P  */ 

/*  rirst  travels  down  the  path  until  pt  1  is  found  */ 

/•  then  constructs  list  btwn  ptl  6  2,  then  finds  its  length  * / 
path_distance (X1,Y1,X2,Y2, (X1,Y1|P),D) 

path_distance2(Xl,Yl,X2,Y2, (XI, Y1 IP J , P12) , 
path_length (F12, D) ,  !. 
path_distance(Xl,Yl,X2,Y2, (X3,Y3,c(C) |PJ,D) 
path_distance  (XI,  Yl,X2,  Y2,  P,  D)  . 
path_distance2 (XI, Yl, XI, Yl,  , ()) . 
patl)7distance2(Xl,  Y1,X2,Y2,7x2,Y2|PJ,  |X2,Y2|)  . 
patirdistancc2(Xl,Yl,X2,Y2. |X3,Y3,c(C) |r), (X3,Y3,c(C) llntbist)) 
path_distance2 (XI, Yl, X2, Y2, P, IntList) ,  ! . 

same(A,A).  /*  succeeds  if  tooth  ergs  are  the  same,  fails  otherwise  */ 

/♦  concat  arg  2  (atom),  onto  end  of  arg  1  (list),  return  as  arg  3  (list)  */ 

cons  ([),B,0)  8“  1. 

cons ( (X|B1] , B2, ( X | B3 } ) 

cons (01, B2, B3) , ! . 

/*  A  robust  arccosine  routine  (in  C-Prolog,  acos(l)  bomb3)  */ 
arccos(X,0) 

X  >  0.99999,  !  . 

arccos(X,A)  A  is  acos  (X) ,  !. 

/*  Remove  tlic  last  pair  of  coords  from  the  lot  arg,  return  as  2nd  arg  V 
rcmove_last_pt  (|X,  Y//.2,  Y2j,  |X,YJ)  . 
remove_lB3t_pt (!X,YIL), |X,Y|KevL]) 
remove_last_pt  (1-,  RevL) ,  !. 
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convert_deyr_to_rads  (Angle_in  _Deg,  Anyle_in_Rad) 
degr_to_rads_factor (F) , 

Angle_in_Rad  is  F*Angle_in_Deg,  ! . 
conver t_rads_to_degr  (T2,  T2Deg)  :  - 
rads  to  dcgr  factor (F2), 

T2Deg  is  F2*T2,  ! . 

degr_to_rads_f actor (F)  F  is  3.14159/100. 

rads_to_degr_f actor (F)  F  is  100/3.14159. 

/*  Succeeds  if  1st  path  includes  2nd  path,  fails  otherwise.  */ 

/«  Assumes  both  arguments  are  bound.  */ 
includes_path (F, F) !. 
includes_path ( (XI , 71 , c (C) I  FI J,P2) 
in-ludes_patli  (FI,  F2) ,  !. 

/*  Succeeds  if  atg  1  is  a  member  of  2nd  arg  (a  list),  else  fails  */ 
member (X, (X I R] )  !. 

member (X, (X2IRJ ) 

member  (X,  R) ,  ! . 

/*  Succeeds  if  args  1  and  2  are  members  of  3rd  arg  (a  list)  */ 

/*  in  order  listed,  else  fails  */ 
member  (X,7,  |>:,Y|RJ)  !. 

member  (X, 7,  (X2, Y2 1 RJ ) 

member (X, 7, R) ,  !. 

/*  Succeeds  if  args  1  thru  4  are  members  of  5th  arg  (a  list)  */ 

/*  in  order  listed,  else  fails  */ 
member (XI , 71 , X2, 72, (XI, 71, X2, 72 1 R) ) ! . 
member (XI, 71, X2, 72, [X3, 73, X4,74 | R) ) 

member (XI, 71, X2, 72,  (X4,  74 | R)),  ! . 

abs(A,A)  A  >»  0. 
aba  (A, -A)  A  <  0. 

/»*»«»*»»«».*****,. »****»***»***»***********»*AA*»***»*******************/ 


/*  UOXE:  For  development  purposes  (until  a  pt-to-pt  path  planner  is  */ 
/*  included  in  the  program)  optimal  paths  from  each  terrain  feature  */ 

/*  vertex  must  be  included  in  the  mapdata  file.  Additionally,  OP's  */ 

/*  from  each  shortcutting  point  along  the  opposite  edge  must  be  incl.  */ 

/*  There  are  two  ways  to  query  an  optimal  path:  V 

/*  1.  optimal_path((X,7|F))  will  got  an  OF  from  pt  X,7  if  such  an  OP  */ 
/*  exists  in  the  database.  */ 

/*  2.  optimal_path((X,7|P|,C)  with  C  unbound  will  get  the  OP  from  X,7  */ 

/*  and  determine  the  cost  of  the  path.  */ 

/*  3.  optimal_patli(|X, Y!F))  will  get  o  'pseudo  OP'  from  X,7  if  one  */ 
/*  exists  and  there  is  no  ' optimal_path' ;  this  is  applicable  to  the  */ 
/*  first  pass  only.  */ 

/  *****  A  *  «  *  *  ******  *  ******  ft  *  *  A  *  *  a  *  a «  *  *  a  **********  A  *  ************ • *  *  «•«»  *  * i 

/*  Computes  the  cost  of  an  optimal  path,  given  the  path  in  the  DB  */ 

optimal_path (L, D) 


var(B),  /*  If  opt  path  with  total  cost  is  already  * / 

optimal_path (L) ,  /*  asserted,  use  it  (bgmapdata  is  consulted  */ 

optim»l_pabh2  (1»,  D) ,  !.  /ft  before  bgutile) ,  else  compute  it  here.  */ 
optimnl_patl»2  ( (XI ,  71, c (C) ,  X2, 72) ,  Dl)  /*  If  opt_path  has  cost  data,  use  */ 

distance (XI, 71, X2, 72, b) ,  01  is  C*D,  I.  /‘this  rule  ns  the  base  case.*/ 
optimal_patli2  ( |X1 ,  Y1 ,  c (C) ,  X2, 72 1  Rost) ,  D)  S-  /*  If  opt  path  lias  cost  data  use  */ 
optimal_pat!i2  ( (72, 72  |P.ost  J ,  D2) ,  /*  this  rule  as  the  rec.  case  */ 

distance  (XS, 71, X2, 72, Dl) ,  Dla  is  C*D1, 

I!  in  hlalK?,,  )  . 
optima)_path  (I,) 

pseudo__optimnl_j.'ath  (L)  . 


/ *  succooiln  if  1st  pt  is  on  lino  segment  botweon  pt2  6  pt3  inclusive  */ 
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on  line(Xl,Yl,Xl,Yl,X2,Y2)  !. 

on~ line  (X2,  Y2,X1,  Yl ,  X2,  Y2)  !. 

on- line  (Xi,  Yi,Xl,Yl,X2,Y2) 

between (Xi, XI, X2) ,  between  (Yi,  Yl,  Y2) , 

DelX  is  X2-X1,  DelY  is  Y2-Y1,  not (between (DelX, 0, 0) ) , 
Yj  is  (Xi-X2) "DelY/DelX  4  Y2, 
wi  till  intolerance  (Xi ,  Yi,  Xi,  Y-i)  ,  !  . 
on_line (Xi , Yi, XI, Yl , X2, Y2) 

between (Xi, XI, X2) ,  between (Yi, Yl, Y2) , 

DelX  is  X2-X1,  DelXi2  is  X2-Xi, 
within_tolerance (DelXi2, Yi, DelX, Yi) ,  ! . 


edge_visibility_check ( (Xa, Ya,Xb, Yb) , (Xg, Yg] ,  (Xa, Ya, v, Xb, Yb) ) 

CrossProdZ  is  (Xb-Xa)  *  (Yg-  Ya)  -  (Yb-Ya)  *  (Xg-Xa) , 

CrossProdZ  >-  0,!.  /*  True  if  AngleGAB  is  between  0  and  pi,  */ 

/*  which  is  true  if  AB  is  visible  from  G.*/ 
edge_visibility_check ( (Xa, Ya, Xb, Yb] , (Xg, Yg) ,  (Xa, Ya, h, Xb, Yb] )  !. 

edge_visibility_check ( (Xa, Ya,Xb,  Yb| RListRest) ,  [Xg,  Yg], 
[Xa,Ya,v|RevisedRListRe3t]) 

CrossProdZ  is  (Xb-Xa) * (Yg-Ya) - (Yb-Ya) * (Xg-Xa), 

CrossProdZ  >-  0,  /*  True  if  AngleGAB  is  between  0  and  pi,  *! 

/*  which  is  true  if  AB  is  visible  from  G.*/ 
edge_visibility_check ( (Xb, Yb | RListRest], [Xg, Yg] , RevisedRListRest) , ! . 
edgc_visibility_check ( [Xa, Ya, Xb, Yb | RListRest ) , [Xg, Yg J , 

(Xa,  Ya, h| RevisedRListRest ] )  S- 

edge_visibility__check  ( [Xb,  Yb  I  RListRest],  [Xg,Yg]  .RevisedRListRest) ,  !  . 

set_done_flag(Xbdry,Ybdry)  s-  /*  Compute  bdry  until  it  is  */ 

maxX (MaxX) ,minX(MinX) ,  /*  off  the  page  by  1/2  the  */ 

maxY (HaxY) ,minY (MinY) ,  /*  width  of  the  page,  to  */ 

Xbdry  >  MinX- (MaxX-MinX) /2,  /*  account  for  rotation.  */ 

Xbdry  <  MaxX4  (Max/.-llinX)  /2, 

Ybdry  >  MinY- (MaxY-HinY) /2, 

Ybdry  <  HaxY4  (HaxY-IlinY) /2,  J. 

set_done_flag (Xbdry, Ybdry)  /*  if  bdry  is  off  the  output  page,  */ 

assert  (done) ,  ! .  /*  set  "done"  */ 

store_2vis_results (T1,T2, Yl, Y2, B, Dg, Vx, Vy) 

Xg  is  Vx  4  Dg*cos(B), 

/baseline  is  Xg  -  Yl*sin(Tl), 

Xbdry  is  Xbaseiine  -  Y2*sin(T2), 

Ybdry  is  Vy  +  Y2*cos(T2), 
set_done_f lug (Xbdry, Ybdry) , 
retract (bdry  (Bl.ist) ) , 
assert (bdry ( [Xbdry, Ybdry IBList) ) ) ,  ! . 


/* 

*  Output  predicates. 

*/ 

output_ini t^b'Jrys 

tc) 1 (bdry_out) , 

number_oI_edges  | ti > , 

write_to_bdry_file  (number_of_odges,  tl) , 
n) , 

initbdry  ( [111  ,112] ,  B)  , 
write_to_bdry_file  (bdry,  R,II1, 112) , 
fail. 

output_i nit_bdrys . 

✓ 
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output_active_bdrya 

tell (bdry_out) , nl, 
act  ivebdi’y  { [HI,  N2J ,  B) , 
wcite_to_bdry_£ile (bdry, B,  HI, H2) , 
fail. 

output_active_bdrya . 


t* 

*  Output  ptolog  facta  to  file  "bdry_out* 

*/ 

vrite_to_bdry_f ile (title, Title)  :- 

write_£laa (no_write) ,  !. 

write_to_bdry_£ile (title, Title) 
write_£lag (write) , 
tell (bdry_out) , 

write  (' title  {'") ,  write  (Title) ,  writo  ("').') ,  nl 

write_to_bdry_£ile (goal, [X,Y]) 

write_£lag (no_write) ,  ! . 
write_to_bdry_£ile (goal, | X, Y J ) 
write_flag (write) , 
tell (bdry_out) , 
wri  te  ('goal  (' ) , 
write ( [X, YJ ) , 
write (').'),  nl. 

wr ite_to_bdry_f ile (number_o£_edgea, H) 
write_£lag (no_write) ,  !. 
write_to_bdry_f  ile  (number_of_edgea,H) 
wr ite_flag (write) , 
tell (bdry_out) , 
write  ('  number_o£_edgea  (' )  , 
write  (M) , 
write  (').'),  nl. 

write_to_bdry_£ile(oppoaite_point,iX, Y,Xm,  Yin, Xp, Yp) )  5- 
write_£log (no_write) ,  !. 

write_to_bdry_file  (oppoaite_poin?-,  [X,  Y,  Xm,  Ym,  Xp,  Yp) ) 
wri te_£lag (write) , 
tell (bdry_out) , 
write  ('  opposite_poi  fit  (' ) , 
wrlte(X),  write(','),  write  (Y), 
write (' )  .' ) ,  nl, 
write ('oppoaite_point_minua (' ) , 
write  (Xm),  write  (',')  ,  write  (Ym), 
write (').'),  nl, 
write  ('oppo.eite_point_plu3  (' ) , 
write  (Xp),  write!','),  write  (Yp), 
write  (').'),  nl. 

writ e_t o_)>d r y_ £ i  le  ( region,  R) 

write_f lag (no_writc) ,  !. 
write_to_bdry_£ile (region, R)  : - 
write  flag (write), 
tell(b'Jry_out) , 

write  (' region  ('),,  write  (ll),  write  (').').  nl. 

write_to_b',lry_  f  i  le  (region  eliat,  P.)  :  — 
write_£lav (no_wiite) ,  (. 
writ  e_tO_b'Jf  y_  £ilc  (region_eliot,  R)  '  * 
wrile_Cl.»g  fwr  jte) , 
tell  (|wJry_<"»Jt) , 

write  (' rcgio!i_cllot  (') ,  write  <P),  write  ('!.'),  nl 


write_to_bdry_£ile  (bdry,  U,  Ml,  N2). 

write_flag (no_write) ,  !.  * 

write_to_bdry_f ile (bdry , B, Ml, M2)  s- 
write_flag (write) , 
tell (bdry_out) , 

write  (' bdry  ('),  * 

write  (|H1,M2J) , write (','> , 

write  (B) , 

write (').'),  nl. 

write_to_bdry_£ile (bdry,B)  s- 

write_£lag (no_write) ,  1. 
write_to_bdry_£ile (bdry,  B)  : - 
write_flag (write) , 
tell (bdry  out ) , 
write  (' bdry  ('), 

write(B)  , 
write  (').'),  nl. 


/* 

*  Output  graphics  instructions  in  "figure*  format  to  file  "bdry_fig" 
*/ 

output_to_f igure_£ile 
tell (bdry_fig) , 
write_heading (bdry) , 
bdry (BdryList) , 

wrlte_to_£ig_£ile (bdry, BdryList) ,  ! . 

write_tc_fig_f ile (title)  s- 
teli (bdry_fig) , 
title (Text) , 
asserts  (subtitle  (' '  ) ) , 
subtitle  (Ter.t2/ , 

assertz (width  of  title (10)),  /*  Default  width  */ 

widtli_of_title(H), 

Indent  is  4.25  -  M/16, 
write  (drawter.t) ,  nl , 

write  (Indent) ,  write  ('  '),  write  (10.3)  ,  write  ('  '),  write  (0) ,  nl , 
write (Text) , nl, 
write  (drawtext) ,  nl, 

write(lndent) , write ('  ' ) ,write(9. 9) , write ('  '), write (0),nl, 
write  (Text.2)  ,nl,  !. 
wcite_to_£ig_f ile (title)  !. 

write_heading  (bdry)  :<• 
tel  1 <bdry_£ig) , 

write (linestyle) , n) ,  write (l),nl, 
write  (linewidth) , nl,  write (0.01) , nl . 

write_heading (region) 

t"l  1  (b'lry_f  i'j) , 

write  (linestyle) ,  nl ,  write  (2) ,  nl, 
write  (linewidth) , nl,  write (0.03) , nl . 

■r-iln.ln  .CU  .ri1>il»lri<  -fv-t  V.I,  «  V9IH..M  I,  ._ 

tell  (bdry.  fly), 
diaw_line'(X  1 ,  -il ,  X?.,  Y2) , 
wr i te_to_f ig_U le (bdry, |X2, Y2| Best ) ) . 
writ.e_to_f  ig^f  i  le  (bdry,  _)  . 

writ«_to_fig_file (inv_bdry,  (X)  ,Yl ,  X2,  Y2|Rest ) ) 
tell (bdry  fig), 
dt«w_line~inv (XI, Y1,X2,Y2) , 
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wcite_to_fiq  file (inv  bdry, (X2, Y2 | Rest ) ) . 
write_to_fig_file(inv_bdry,_)7 

write_to_fig_file(goal,  |X,YJ) 

tell (bdcy_fig) , 
scale_coords (X,  Y,  XI ,  Yl ) , 
write (linestyle) , nl,  write (1) , nl, 
write (circle) , nl, 

write(Xl), write('  '), write (Yl), write ('  write (0),nl, 
write (0.04) , nl,  !. 
write_to_fig_file (inv_goal, (X,YJ) 

tell (bdry_£ig) , 
scale_coords_inv (X, Y, XI, Yl) , 
write (linestyle) , nl,  write (1) , nl, 
write (circle) , nl, 

write  (XI),  write  ('  '),  write  (Yl),  write  ('  '),  write  (0),nl, 
write (0. 04), nl,  !. 


write_to_fig_file (region, (XI, Yl (Rest]) 
tell (bdry_fig) , 

write_to_f ig_f ile2 (region, (X  ■ ,  Yl  | Rest J ,  Xend, Yend) , 
dtaw_line(xl,Yl,Xend,Yendj ,  !. 
write_to_£ig_£il«2 (region,  (X,YJ,X,Y)  . 
write_to_fig_file2 (region, (XI, Y1,X2, Y2|neatj , Xend, Yend) 
tell (bdry_fig) , 
draw_linelxi , Yl , X2,  Y2) , 

wr  ite_to_fig_£ile2  (region,  (X2,Y2 1  Rest),  Xend,  Yend),  }. 

write_to_fig_file(inv_region, (XI, Yl,x2, Y2|Rest)) 
tell (bdryf ig) , 
draw_line~inv (XI , Yl , X2, Y2) , 
write_to_fig_file(inv_region,  (X2,  Y2|.lest) ) ,  !. 
write_to_£ig_file (inv_rogion,_) . 


3cale_coords(X,Y,Xl,Yl) 

maxX  (MaxX)  ,maxY  (MaxY) ,  minX  (HinX)  ,minY(Mii»Y) , 
XI  is  1  +  (6.5* (X-MinX) / (MaxX-HinX) ) , 

Yl  is  1  4  (9* (Y-MinY) / (HaxY-MinY) ) ,  !. 
scale_coords_inv (X, Y, XI , Yl ) 

maxxTMaxX)  ,maxY  (»4axY)  ,minX  (Mi  nX) ,mlnY  (MlnY) , 
XI  is  7.5  -  (6.5* (X-MinX) / (MaxX-MinX) ) , 

Yl  is  1  4  (9* (Y-MinY) / (MaxY-MinY) ) ,  !. 


/*  Scales  and  translates  •/ 
/*  coords  to  appropriate  */ 
/»  output  coord  system  */ 

/*  also  reflects  tlie  */ 
/*  coords  about  tlie  »/ 
/*  vertical  line  X-4.25  »/ 


draw_line(XJ,Yl,X2,Y2) 

scale_cootds (XI, Yl, Xlb,  Ylb) , 
scale_coorda (X2, Y2, X2b,  Y2b) , 
write  (polyline) ,  nl,  write  (2) ,  nt, 
wri  te  (Xlb) ,  write  ('  ' ) ,  write  (Ylb) ,  write  (' 
write  (X2b)  , write  ('  ' ) ,  write  (Y2b) , write  (' 
draw_line_inv(Xl,Yl,X2,Y2) 

scale_coords_inv  (XI,  Yl ,  XI  b,  Ylb) , 
sc*le_coords_iiiv (X2,  Y2, X2b,  Y2b) , 
write (polyline) , n) ,  write (2) , nl , 
wri  te  (Xlb) ,  wri  te  ('  • ) ,  wr  i  te  (Ylb) ,  wr  i  te  {' 
write  (X2b) ,  write  ('  ' ) ,  write  (Y2b) ,  write  (' 


' ) ,  write  (0)  ,nt , 
'), write (0),nl, 


'),  write (0),nl, 
' ) ,  write  (0) ,  ill. 


i 


! . 


281 


/AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

AAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAAA 

A 

*  "bgmd22" 

A 

*  File  "bgmapdata"  has  terrain  and  goal  data  uaed  by  "bdrygen". 


********* . . . . . . . * . AAAnAAAAAAAAAAA/ 

/*  "region_verticea"  lists  the  vertices  of  one  MCA 

*  in  clockwise  order.  First  point  listed  can  be  any 

*  of  the  vertices. 

*/ 

region_vertices  <(4,  20, 30, 70, 40, 71, 60, 30,  36,  8] )  . 
title  ('Example  22')  . 
goal_point (35, 84)  . 


/*  "_cost"  is  the  time  required  to  travel  one  unit  of  distance. 

*  Note  that  this  is  the  inverse  of  the  "cost"  used  in 

*  the  "sis"  code. 

*/ 

interior_cost  (2)  . 
erterior_cost (1) . 


/» 

*  "optimal_patli"  is  a  temporary  set  of  predicates  which  specify 

*  the  optimal  path  list  from  each  vertex  in  the  map . 

*  Eventually,  it  will  be  replaced  by  a  rule  which  computes 

*  the  optimal  path  using  a  path-finding  routine  such  as 
"sis"  dr  "rrr". 


optimal  path U'l, 20, c(l), 30,70, c(l), 35,84 J)  . 
optimal_path ( (30, 70, c(l) ,  35,  84 J )  . 
optimal_path  ( (36,  8,c(l) ,  60,  30,  c(l) ,  35,  84  J  )  . 
optimnl_path ( | 60, 30, c (1 ) ,35,84)) . 
optimc l_path ( ( 40, 71 , c (1) , 35, 84] ) . 
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